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'The  purpose  of  this  thesis  is  to  discuss  the  observ¬ 
ability  of  targets  moving  on  cr  near  the  earth's  surface 
when  viewed  from  space  by  an  orbiting  satellite.  A  simpli¬ 
fied  derivation  of  the  satellite's  orbital  mechanics  is 
undertaken,  which  taken  in  conjunction  with  a  description  of 
the  target's  motion  allows  for  the  derivation  of  a  system  of 
relative  coordinates.  An  observability  analysis  is  then 
performed  on  the  resulting  series  of  nonlinear  equations, 
which  in  turn  forms  the  basis  for  the  design  of  a  determin¬ 
istic  nonlinear  observer  and  an  Extended  Kalman  Filter  to 

track  tfce  target. JL^^r <U_  IwJLuL*  :  N  ,3 
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GSi  as  a  Function  of  Altitude 
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The  second  aspect  of  swath  width  is  minisum  swath  width 
(MSW)  required  for  coverage,  as  a  function  of  the  number  of 
revolutions  per  day.  Because  the  swaths  cut  by  a  satellite 
in  a  circular  orbit  are  most  widely  spread  as  it  crosses  the 
equator,  this  simply  means  computing  n,  the  number  of 
equator  crossings  per  day,  and  then  swath  angle  is  defined 
as 
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Taking  into  account  both  the  ascending  and  descending 
trajectories,  the  typical  satellite  orbit  can  actually  be 
considered  to  cross  the  equator  twice  per  revolution  (see 
Figures  2.3  and  2.4),  and  so  is  a  sufficient  swath 
width  to  ensure  coverage  along  the  entire  equator,  which  is 
of  course  a  worst-case  approach  for  achieving  coverage  of 


25 


satellites,  are  the  related  concepts  of  swath  width  and 
revisit  time  interval.  Swath  width  relates  directly  to  that 
area  viewed  by  the  satellite  as  it  passes  overhead;  revisit 
time  is  the  measure  of  how  frequently  a  particular  point  on 
the  ground  is  in  view  from  a  passing  satellite. 


PRECESSION  RATE  IN  DCGREE5  PER  Dfil 


REPRODUCED  AT  GOVERNMENT  EXPENSE 


Figure  2.4  Satellite  Ground  Track 
For  a  nominal  Period  of  Twelve  Hours 


The  last  factor  that  must  be  considered  to  achieve  abso¬ 
lute  accuracy  in  predicting  the  satellite's  orbital  path  is 
the  non-spherical  shape  of  the  Earth;  to  wit,  the  Earth  is 
actually  a  slightly  oblate  ellipsoid,  which  causes  a  slow 
drift,  or  precession,  of  the  satellite's  orbital  plane 
around  the  Earth  with  respect  tc  the  fixed  stars.  [Bef.  5] 
includes  a  detailed  discussion  cf  the  effects  of  precession 
on  the  orbital  plane,  including  the  derivation  of  a  formula 
for  precession  rate,  which  is  offered  here  without  proof; 
for  a  circular  orbit. 
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REPRODUCED  AT  GOVERNMENT  EXPENSE 


Consider  now  that  the  Earth  is  rotating  in 
direction;  the  rate  at  which  east  longitude  is 
the  satellite  is  now  decreased  by  the  Earth's 
speed,  or 


COS  v.  <^> 
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an  easterly 
traversed  by 
rotational 


(2.3) 


Employing  eguations  2.7  and  2.8  for  the 
tude  and  longitude  respectively  led 
generated  ground  tracks  shown  in  Figures 
typical  orbital  periods  {note  that  tne 
60  degrees  in  both  cases)  . 


generation  of  lati- 
to  the  computer- 
2.3  and  2.4  for  two 
inclination  angle  is 


2  1 


(2.4) 


A  =  tan’'  Y/^ 


If  the  Earth  were  truly  a  stationary  sphere,  these  equa¬ 
tions  would  be  sufficient  to  describe  the  satellite's 
motion.  Because  the  Earth  is  actually  spinning  under  the 
satellite,  however,  angular  rates  must  be  considered,  so 
that  the  Earth’s  rotational  speed  (shown  as  ol*  in  Figure 
2.2)  may  likewise  be  considered.  Therefore  equations  2.3 
and  2.4  above  must  be  differentiated  with  respect  to  time  as 
follows  (note  that  i  is  time-independent)  : 
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Substitute  equations  2.5  into  eauations  2.6, 
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Figure  2.2  Inclination  of  the  Orbital  Plane 


If  the  orbital  plane  is  then  rotated  about  the  X  ax 
through  i  degrees,  then  the  coordinates  are  transformed  by 
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that  is,  now 
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and  the  latitude  and  longitude  are  described  by 


disturbances  will  produce  oscillations  about  the  reference 
orbit  with  its  same  period,  i. e . 
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B.  SATELLITE  GBOUHD  TRACK 
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The  earth- satellite  model  as  developed  in  Section  A  is 
obviously  over-simplified  for  the  purposes  of  target 
tracking;  thus  far,  the  Earth  has  been  represented  only  as  a 
point  mass  rather  than  as  a  spinning  globe,  which  would  make 
it  extremely  difficult  to  describe  any  motion  across  the 
Earth’s  surface. 

One  intrinsic  feature  of  a  satellite's  orbit  use-3  ;n 
measuring  its  flight  path  is  the  inclination  angle  i,  which 
represents  the  positive  angle  between  the  orbital  plane  and 
the  equatorial  plane.  This  angle  can  be  used,  together  with 
earth's  surface  coordinates,  to  describe  the  path  over 
ground,  or  ground  track,  of  the  satellite. 

In  Figure  2.2,  the  Z  axis  coincides  with  the  Earth's 
polar  axis;  L  and  A  measure  ncrth  latitude  and  east  longi¬ 
tude  respectively;  and  r,  ,  and  \  describe  the  satel¬ 
lite's  motion  in  its  orbital  plane  as  before. 

If  the  satellite  is  considered  to  have  originally 
orbited  in  the  equatorial  plane-,  its  position  would  have 
been  described  by 


Ik  "  V  , 

X  ~~  r  4  , 


must  be  subtracted,  i.e. 

h  =  r  -  r 

O 

Of  special  interest  is  the  satellite  at  zero  altitude, 
also  known  as  a  Herget  satellite,  with  a  period  of  84.5 
minutes.  As  [Be£.  5]  indicates,  this  gives  a  value  for  the 
lower  bound  of  a  satellite's  period.  Some  other  periods  and 
altitudes  of  interest  are  summarized  in  Table  I  : 


TABLE  I 

Typical  Periods, 

Altitudes,  and 

Orbital  Velocities 

Period  T 

Altitude  h 

Orbital 

Velocity 

90  min 

150  nir 

15030 

knots 

3  hr 

2250  nil 

11930 

knots 

6  hr 

5600  si 

9470 

knots 

12  hr 

10900  ns 

7510 

knots 

23  hr  56  min 

19322  nm 

5970 

knots 

Thas  last  orbit,  with  a  period  of  one  solar  day,  is  the 
geosynchronous  orbit  frequently  adopted  in  satellite  commu¬ 
nications  applications;  for  tracking  of  surface-bound 
targets,  however,  low-altitude  orbits  will  be  of  much 
greater  interest.  Typical  altitudes  will  generally  be  less 
than  1000  nautical  miles,  depending  on  the  sensitivity  and 
accuracy  of  the  tracking  sensor:  this  corresponds  to 
periods  of  two  hours  or  less. 

Finally,  it  can  be  shown  by  the  method  of  the  potential 
energy  well  [Hef.  6],  and  alsc  by  the  application  of  the 
theory  of  perturbations  [Ref.  4  j,  that  this  reference  crtit 
will  be  stable  in  the  presence  of  small  disturbances  in 
either  the  orbital  plane  or  the  third  dimension,  and  these 


Equation  2.2  indicates  that  angular  momentum  is 
conserved  (i.e.  its  derivative  is  zero),  and  that  will  be 
constant  for  a  given  orbital  radius.  Further,  if  the 
angular  momentum  vector  is  interpreted  as 

^  -  VV\  (  C  c  VWT*  4  c 


then  the  fact  of  its  conservation  indicates  that  the  orbit 
will  remain  stable  in  its  original  plane.  The  introduction 
of  a  third  coordinate,  which  ultimately  becomes  the  angle  of 
inclination  i,  and  which  remains  arbitrary  throughout  the 
Lagrangian  derivation,  proves  this  conclusively. 

Solving  equation  2.1  for  the  the  physical  constants 
reveals  that 


Considering  that 


where  T  is  the  satellite's  period,  then 

JL3  -  GH 

T 


for  a  satellite  in  an  earth  orbit;  this  is  Kepler's  Second 
law  of  Orbital  Motion. 

The  radius  in  this  equation  is  the  distance  of  the 
satellite  from  the  Earth's  center;  for  altitude  above  the 
Earth,  the  Earth’s  radius,  here  represented  as 


r 


3438nm  =  6366km 


Figure  2.1  Satellite  Orbit  in  its  Plane 


The  circular  orbit  is  the  sinplest  case,  such  that  the 
velocity  is  purely  tangential  and  can  be  characterized  as 

\4  -  r<^  . 

The  kinetic  energy  T  is  then 

-  -X- 

T  --  -■ 

and  in  the  absence  of  any  external  disturbances,  the 
Lagrangian  function  is  written  as  follows: 

-  T-AJ-  G!yu/V  ■ 

By  the  rules  of  Lagrangian  mechanics, 
d-t  ^  ’ 


II.  SATELLITE  DYNAMICS  AND  OBSERVATION  OF  TARGETS 

In  considering  the  tracking  of  a  surface  or  air  target 
by  a  satellite  hurtling  through  space  at  speeds  approaching 
15000  knots,  it  is  obviously  imperative  to  understand  the 
dynamics  of  the  motion  of  the  satellite.  Only  then  can  a 
relative  coordinate  system  be  established,  with  the  ultimate 
goal  of  describing  the  target’s  motion  over  the  Earth’s 
surface;  first,  however  ,  the  satellite’s  own  motion  must  be 
similarly  described. 

In  the  following  derivations,  the  Earth  will  be  approxi¬ 
mated  by  a  unif ormly-dense,  perfect  sphere.  This  approxima¬ 
tion  has  often  been  characterized  qualitatively  as  being 
twice  as  good  as  that  of  a  "spherical"  basketball;  its  quan¬ 
titative  implications  will  be  discussed  in  Sections  B  and  C 
below . 

A.  SATELLITE  REFERENCE  ORBIT 

Lagrangian  Mechanics,  as  developed  in  [Ref.  4]  offers 
the  easiest  method  for  analyzing  the  satellite’s  motion. 
The  Earth  and  the  satellite  can  each  be  represented  by  point 
masses;  in  the  absence  of  external  disturbances,  it  can  be 
shown  that  the  satellite’s  orbit  will  remain  planar.  The 
gravitational  potential  of  the  satellite  is  inversely 
proportional  to  its  distance  from  the  Earth;  using  circular 
polar  coordinates  as  shown  in  Figure  2.1,  this  potential 
energy  "V*  is  then  described  by 

Y  - 

where  G  is  Newton's  constant  of  universal  gravitation,  H  is 
the  mass  of  the  Earth,  and  m  is  the  mass  of  the  satellite. 


Chapter  IV  finally  tackles  the  problem  of  state  observ¬ 
ability.  Observability,  as  defined  here  and  in  [Eef.  1],  is 
the  capability,  given  the  observations  and  knowledge  of  the 
control  input  to  the  system  ~ver  time,  to  reconstruct  the 
entire  system  state  tack  to  the  initial  condition.  Testing 
for  this  condition  on  a  linear  system  is  perfectly  straight¬ 
forward;  the  method  is  fully  developed  in  [Her.  2]  and  else¬ 
where.  The  observability  of  the  nonlinear  system  Is  by  far 
the  mere  interesting  problem,  as  the  problem  is  mere  real¬ 
istic,  and  the  methodology  for  testing  of  nonlinear  observ¬ 
ability  is  far  less  well  developed  and/or  documented.  To 
that  end,  the  method  which  is  newly  developed  in  [Ref.  1]  is 
herein  employed,  and  the  analysis  ultimately  becomes  as  much 
of  a  test  of  the  method  as  the  observability  of  the  system. 

Based  on  the  results  of  the  analysis  in  Chapter  IV, 
Chapter  V  is  then  an  admittedly  imperfect,  first-cut  attempt 
at  designing  a  deterministic  nonlinear  observer,  and  then 
tracking  the  target  with  an  EKF.  The  comments  in  [Hef.  3] 
concerning  filter  initialization  and  measurement  covariance 
estimation  become  pertinent. 

Finally,  Chapter  VI  summarizes  the  thesis’  results,  and 
makes  some  suggestions  for  farther  analysis,  specifically  in 
the  area  of  multiple  targets  and  observers.  The  real- world 
significance  of  the  report  is  also  discussed. 
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I-  INTRODUCTION 


In  pursuit  of  an  interest  in  the  problems  and  potential 
of  satellite  tracking  of  earth's  surface  or  low  altitude 
targets,  the  interested  student  guickly  discovers  a  plethora 
of  information  available  on  the  subject,  but  little  in  the 
way  of  analysis  of  the  entire  problem,  start-to-f inish .  The 
purpose  of  this  report  then  is  to  provide  that  analysis, 
beginning  with  the  mechanics  of  the  orbiting  satellite;  next 
developing  a  model  to  represent  the  target  motion;  and 
continuing  through  an  observability  analysis  of  the  problem, 
finally,  a  first-cut  attempt  is  made,  based  on  the  observ¬ 
ability  study,  to  design  a  deterministic  nonlinear  observer 
and  an  Extended  Kalman  Filter  (hereafter  referred  to  as  an 
EKF)  to  observe  and  track  the  target. 

Chapter  II  of  this  report  examines  in  depth  the  physical 
dynamics  of  a  satellite  orbiting  the  Earth,  and  then  the 
target  moving  on  or  just  above  its  surface.  A  working  model 
is  developed  for  the  satellite,  including  a  look  at  its 
ground  track;  its  rotation  about  its  own  axes  as  it  moves 
through  space;  and  the  translation  of  its  raw  observed  data 
into  earth's  surface  coordinates.  Both  position  and  rate 
data  are  considered,  and  specific  formulae  are  developed 
along  the  lines  of  a  computer  algorithm  for  coordinate 
transformation. 

Chapter  III  deals  more  specifically  with  the  node!  for 
the  target  itself.  Actually,  two  models  are  considered: 
first,  a  realistic  model,  necessarily  nonlinear,  due  tc  the 
non-synchronous  motion  of  the  target  and  satellite  on 
concentric  spheres;  and  then  secondly  a  slightly  nonreal- 
istic  linearized  version.  Both  surface  and  air  targets  are 
considered,  but  for  brevity's  sake,  only  the  surface  target 
is  discussed  fully  in  the  various  examples. 


the  entire  globe.  This  leads  to  the  information  summarized 
in  Table  III;  the  last  (geosynchronous)  case  is  obviously 
unrealistic  for  tracking  applications,  as  tfSW  is  greater 
than  GSW  . 


TABLE  III 

HSU 

as  a  Function 

of  Altitude 

h 

n 

©s 

MSK 

150 

nm 

16 

11.25* 

675  nm 

600 

nm 

13. 

41  13.47° 

808  nm 

2250 

nm 

8 

22.5° 

1350  nm 

5600 

nm 

4 

45° 

2700  nm 

10900 

nm 

2 

90° 

5400  nm 

19322 

nm 

1 

180 

10800  nm 

The  overlap,  or  difference  between  Tables  II  and  III, 
determines  the  maximum  number  of  times  a  single  satellite 
can  possibly  view  a  stationary  target  on  the  equator  during 
successive  orbits.  This  number  N  can  be  calculated  by 
dividing  twice  equation  2.10  by  equation  2.12,  or 


-if 


X.o'b 


'h 


Unfortunately,  average  time  between  revisits  cannot  be 
characterized  as  24  hrs/N,  as  successive  swaths  will  overlap 
on  consecutive  orbits,  and  then  the  target  will  not  be  illu¬ 
minated  for  several  orbits.  At  this  point  it  is  necessary 
to  place  additional  satellites  in  the  orbital  pattern,  or 
constellation,  to  ensure  coverage  during  every  orbit,  i.e.  a 
minimum  of  360/GSW  (rounded  up)  is  required.  This  will  then 
provide  n  visits  per  day  to  the  equatorial  target,  where  n 
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is  again  as  defined  in  equation  2.11  .  Once  this  has  been 
achieved,  insertion  of  additional  satellites  will  only 
continue  to  increase  the  revisit  frequency  while  correspond¬ 
ingly  decreasing  the  revisit  tine. 

The  last  factor  in  this  ievisit  time  problem  is  the 
consideration  of  horizon-to-hor izon  coverage  along  the  path, 
that  is,  until  now  the  discussion  has  only  dealt  with  meas¬ 
uring  the  time  between  successive  CPA's  (Closest  Point  of 
Approach)  of  the  satellite  to  the  target.  As  Figure  2.7 
indicates,  however,  the  target  is  actually  in  view  lcng 
before  the  satellite  passes  overhead,  and  remains  in  view 
until  the  satellite  passes  over  the  far  horizon. 
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Figure  2.8  Viewing  Angle 
This  translates  to  a  viewing  tine  of 
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For  a  surface  target  and  a  satellite  at  150  nm  elevation, 
this  translates  to  a  time-in- view  of  8.3  minutes.  This 
viewing  time  will  increase  as  satellite  altitude  increases, 
and  decrease  as  the  target  moves  toward  the  outside  of  the 
swath.  Eegardless,  the  revisit  time  between  target  observa¬ 
tions  is  always  decreased  by  this  viewing  time. 

The  final  facet  of  ground  coverage  to  be  considered  is 
coverage  at  the  poles.  Having  used  the  Eguator  as  the  worst 
case  for  swath  spreading,  one  might  then  expect  the  swaths 
to  converge  at  the  poles.  Actually,  the  convergence  of  the 


Figure  2.9  Hiniaum  Inclination  for  Polar  Coverage 
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Table  IV  summarizes  these  results  for  typical  orbital 
heights. 


TABLE  17 

Minimum  Inclination  for  Polar  Coverage 


h 

i 

150 

nm 

73.4 

600 

nm 

53.4 

2250 

nm 

37.2 

5600 

nm 

22.4 

10900 

nm 

13.9 

19322 

nm 

8.7 

To  summarize  thus  far,  a  satellite  placed  at  an  altitude 
of  600  nm  would  be  useful  for  tracking  purposes;  its  GSW  of 
63. 4C  and  MSW  of  13.47°  ensure  that  a  target  would  be  viewed 
on  at  least  four  (and  probably  five)  consecutive  passes,  and 
its  orbital  period  of  107.4  minutes  indicates  that  the 
target'  would  be  viewed  frequently  enough  to  acquire  timely 
and  significant  information  about  its  location,  course,  and 
speed.  Inclining  it  a  minimum  of  58.4  degrees  would  ensure 
coverage  of  both  pcles,  and  its  precession  rate  of  -3 
degrees  per  day  (or  about  -0.2  degrees  per  orbit)  would  not 
deter  its  ability  to  maintain  track  on  the  target. 
Beaiistically,  a  single  satellite  would  not  be  used;  the 
placement  of  a  minimum  of  six  in  the  constellation  would 
ensure  that  no  target  would  go  more  than  one  period  without 
being  observed,  and  the  placement  of  additional  satellites 
would  only  then  increase  the  frequency  of  target 
observation. 

D.  SATELLITE  OfilENT ATIOM  IN  SPACE 

Having  developed  a  working  model  for  the  orbiting  satel¬ 
lite,  the  next  phase  cf  the  pro  Hem  will  consider  the  satel¬ 
lite’s  observation  of  its  target,  either  by  passive  (i.e. 
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IE)  or  active  (i.e.  search  radar)  means.  First,  however,  a 
coordinate  frame  of  reference  for  that  observation  is 
required.  Thus  far  the  assumption  that  the  satellite  can  be 
represented  by  a  point  mass  has  sufficed;  nov,  however,  it 
must  be  realized  that  the  satellite  has  dimension,  is  irreg¬ 
ularly  shaped,  and  quite  possibly  undergoes  radical  attitude 
changes  throughout  the  course  of  its  orbit.  It  is  therefore 
imperative  that  the  satellite  be  able  to  orient  itself  with 
reference  to  its  ground  point,  that  is,  the  point  on  the 
Earth’s  surface  directly  between  the  satellite  and  the 
Earth’s  center.  This  is  because,  realistically,  the  satel¬ 
lite  will  be  measuring  (at  best)  a  line-of-sight  range  and  a 
series  of  angles  (probably  altitude  and  azimuth)  to  the 
target:  it  is  these  angles  that  must  be  oriented  with 
respect  to  the  reference  directions,  in  order  that  the  data 
fed  to  the  tracking  computer  be  consistent. 

In  considering  Figure  2.10,  Figures  2.10  (a)  and  2.10 
(e)  show  the  space  reference  orientation  and  the  satellite 
aligned  in  that  orientation;  Figures  2.10  (b)  ,  (c)  ,  and  (d) 
show  the  initial  position  and  intermediate  rotations  of  the 
satellite  axes  required  to  achieve  that  orientation.  It 
should  be  emphasized  that  these  rotations  are  computational 
rather  that  mechanical;  as  long  as  the  target  falls  within 
the  sensor’s  coverage  area,  there  is  no  need  to  actually 
physically  rotate  the  satellite  into  any  new  position. 
Rather  the  target  coordinates  are  transformed  mathematically 
as  follows; 

Step  1.  Rotate  around  the  x  axis  by  7  ^  to  get  y  axis 
into  "NEH  plane. 
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Figure  2. 10  Translation  of  the  Satellite 
To  the  Reference  Orientation 


Step  2.  Rotate  around 
axis  in  the  "D"  direction. 
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Step  3.  Hotate  around  the  z  axis  by  to  get  the  x 
and  y  axes  aligned  in  the  "N"  ard  "E"  directions. 
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_ 

Thus  to  get  from  x-y-z  coordinates  to  N-E-D  coordinates,  the 
transf or mation  is 


E  -  T;T/1  b  • 


(2.  13) 


Figure  2.11  Angles  Transformed  to  Rectangular  Coordinates 

There  is  actually  another  step  involved  both  before  and 
after  the  transformation  of  equation  2.  13,  that  of  trans¬ 
forming  from  the  angles  to  the  rectangular  coordinates  and 
back.  The  translation  from  an  initial  set  of  raw  angular 
measurements  to  the  satellite's  x-y-z  rectangular  coordi¬ 
nates  is  shown  in  Figure  2.11  .  The  corresponding  equations 
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>s._  (2.  co-s  ^ 

^  -  Px  "5«n»  /o, 

^  -  i2-  tci  fi0  .  (2.  14) 

Meanwhile,  the  transformation  from  the  N-2-D  reference 
rectangular  coordinates  to  the  observed  angular  coordinates 
is  depicted  in  Figure  2.  12,  and  described  mathematically  by 


o(  -  t*n“  e  /m 

> 

^  =  co.<r' 


(2.  15) 


It  is  worthy  of  note  that  R  remains  unchanged  by  all  the 
transformations;  only  o(  and  g  change.  Thus  the  complete 
transformation  from  angles-ref erenced-to-sa tellire  to 
angles- referenced-to-ground  is 
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Step  3.  Rotate  around  ths  z  axis  by  Ji  to  get  the  x 
and  y  axes  aligned  in  the  "S"  a  r.d  "E"  directions. 

f  CO',  ^  *..4  ^  cA 
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Thus  to  get  from  x-y-z  coordinates  to  N-E-D  coordinates,  the 
transformation  is 
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Figure  2.11  Angles  Transformed  to  Rectangular  Coordinates 


There  is  actually  another  step  involved  both  before  and 
after  the  transformation  of  eguation  2.13,  that  of  trans¬ 
forming  from  the  angles  to  the  rectangular  coordinates  and 
back.  The  translation  from  an  initial  set  of  raw  angular 
measurements  to  the  satellite's  x-y-z  rectangular  coordi¬ 
nates  is  shown  in  Figure  2.11  .  The  corresponding  equations 


Figure  2.12  Rectangular  Coordinates  Transformed  to  Angles 


Figure  2.13  Observing  the  Target  from  Space 


E.  SATELLITE  OBSERVATION  OF  A  NEAR-SORFAC E  TARGET 

Eguations  2.16  detail  the  realignment  of  raw 
information  along  the  space  reference  axes. 
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Figure  2.14  Satellite- Tar get-Earth  Center  Triangle 


final  step  in  calculating  target  position  and  velocity  on 
the  Earth's  surface  is  to  translate  the  range  and  the  space 
angles  into  earth's  surface  coordinates,  i.e.  latitude  and 
longitude.  Figure  2.13  shows  the  pertinent  variables,  while 
Figure  2.14  shows  the  triangle  formed  by  the  satellite,  the 
target,  and  the  earth's  center.  The  latter  figure  presumes 
a  surface  target;  the  case  of  an  air  target  will  be 
discussed  momentarily. 

To  find  the  earth's  surface  distance  along  a  great 
circle  passing  through  the  ground  point  and  the  target's 
position,  one  need  only  find  the  earth-central  angle with 
the  law  cf  cosines,  as  shown  in  Figure  2.14  , 
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and  then  the  arc  length,  or  surface  distance 
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Figure  2.  15  Sane  Triangle  for  an  Air  Target 


Note  that  the  angle  A  was  not  required  in  this  calculation; 
it  is  required,  however,  for  calculations  involving  an  air 
target  of  unknown  altitude,  as  shown  in  Figure  2.15  Solvinj 
for  the  target  height  requires  applying  the  law  of  cosines 
again ; 
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(2. 18) 


and  then 


follows  from  the  law  of  sines: 
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ft  S '  fi 
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(2. 19) 


and  once  again. 


In  either  case,  cr*ce  the  great  circle  distance  from  the 
ground  point  to  the  target  is  known,  the  target's  latitude 
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To  obtain  /6,  the  law  of  cosines  is  again  applied  to  Figure 
2.15,  this  time  yielding 
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{3. 16) 


The  observation  model  is  summarized  in  Figure  3.3  .  Any 
realistic  computational  procedure  would  of  course  use  the 
intermediate  variables  L,  A  /  7C  ,  ,  and  their  deriva¬ 
tives;  for  the  sake  of  completeness,  however,  it  should  be 
noted  that  the  observer  functiors  could  be  written  as  func¬ 
tions  cf  the  original  state  vector. 


To  solve  for 
follows : 


^  ,  equation  2.21  is  rewritten  as 


=  Stvi  Lj  -t  ecs  \_i  Ccsl^C^S 


(3.9) 


and  then  -  -  L-y  (  cost^  S\~t^  -  -Si^Lt  Cosi^CosTt) 
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Enough  information  is  new  available  to  solve  for  the 
space  coordinates  R,  (X  /  /$  ,  and  their  derivatives.  To 
obtain  R,  the  law  of  cosines  is  applied  to  Figure  2. 15  as 
follows: 

(t**  Gf**WY*  C  (v„rU,V  J 

so 
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To  obtain  0^ ,  the  law  of  sines  for  spherical  triangles  i  < 
applied  to  Figure  2.16  as  follows: 
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Assuming  that  external  nonlinear  forces  such  as  wind  or  sea 
drag  are  either  negligible  and/or  unpredictable,  this 
completes  the  target  model. 


Satellite  Observation 


The  observer  matrix  H  will  obviously  be  a  nonlinear 
operator  on  the  state  vector.  To  begin  its  derivation,  the 
n-e-hT  coordinates  must  be  transformed  to  latitude- 
longitude-altitude  coordinates  by  solving  eguations  3.1  in 
reverse  ,  and  then  differentiating  as  follows: 
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The  ultimate  goal  of  this  transformation  will  be  to  express 
the  space  observations  in  terms  of  the  state  vector,  i. e. 
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First,  however,  it  is  useful  to  calculate  in  terms  of  the 
state  vector  the  intermediate  variables  yt  and ,  as  they 
were  defined  in  Figure  2.16  .  Solutions  for  are 

trivial : 
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have  six  state  variables,  defined  by  the  quantities  devel¬ 
oped  in  Part  k  of  this  chapter  as  follows: 


x,  =  n  =  northerly  distance  traveled  (nm)  , 
x  t,  ~  n  =  Vu  =  Vcos 4  =  northerly  velocity  (xts) , 
Xj  =  e  =  easterly  distance  traveled  (na)  , 
x*  «  e  =  Vg  =  Vsin<f>  =  easterly  velocity  (ktsj  , 
xf  =  hT=  altitude  above  earth's  surface  (nm)  , 
x «,  =  hT=  rate  of  climb  {kts)  ; 


and  negative  values  for  these  variables  represent  southerly 
distance,  southerly  velocity,  westerly  distance,  westerly 
velocity,  (no  negative  altitude)  ,  and  rate  of  descent, 
respectively.  For  a  surface  target,  x4-  and  x0  are  zero;  for 
a  constant-altitude  air  target,  x^  is  zero.  The  target  is 
thus  modeled  continuously  by 
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where  u  (t)  represents  either  noise  in  the  n-e-h  T  system,  or 
else  acceleration  in  the  three  directions.  Realistically, 
because  computation  requires  a  finite  time  and  one  satellite 
cannot  normally  be  dedicated  solely  to  observing  a  single 
target,  the  observations  will  necessarily  be  discrete,  and 
hopefully  periodic  in  time  T.  The  discrete  model  analogous 
to  that  of  equation  3.4  is 
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Now,  the  discussion  of  Chapter  II  essentially  derives 
the  system  equations  for  describing  a  target's  motion  in 
terms  of  space  coordinates;  however,  to  have  a  near-earth 
target  described  in  terms  of  E,  ol  ,  /St  and  their  deriva¬ 
tives  would  not  necessarily  be  useful,  as  it  would  require 
all  the  coordinate  transformations  of  Chapter  II  to  be 
performed  over  again  to  relay  any  useful  information  to  the 
ground.  In  addition,  the  presumption  of  a  constant  (in  the 
absence  of  control  input)  course,  speed,  and/or  rate  of 
climb  (air  target)  would  be  mathematically  impossible,  since 
these  coordinates  would  not  be  available;  therefore,  since 

«  o  • 

assuming  constant  R  ,  ck  ,  and  yS  would  still  not  achieve 
constant  VN  ,  V6  ,  and  hT,  the  second  derivatives  of  B,  ^  , 
and  $  would  be  required,  i.e.  the  differentiation  of  equa¬ 
tions  2.24  through  2.31  .  To  avoid  this  unnecessary  compli¬ 
cation,  the  reverse  derivation  will  be  performed  here,  i.e. 
a  description  of  both  target  motion  and  space  observation  in 
terms  of  earth's  surface  coordinates.  The  model  will  be 
derived  for  the  most  general  case,  i.e.  all  variables  non¬ 
zero.  The  constant  altitude  aircraft  or  surface  target  will 
be  considered  simply  to  be  special  cases  of  this. 

1 .  Target  Model 


If  the  target  is  presumed  to  maintain  a  constant 


course  and  speed  in  the  absence  of  a  control  input  (acceler¬ 
ation)  ,  a  simple  one-dimensional  model  might  take  the  form 


of 


iW  .  °  '1  K(0 

O  G 

i 


where  u  (t)  can  actually  be  either  system  noise  or  an  accel¬ 
eration.  Since  three  mutually  perpendicular  coordinates  are 
required  to  describe  the  target  position,  the  system  should 
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Figure  3.2  Resolution  of  the  Velocity  Components 

becomes  necessary  effectively  tc  work  backwards  through  the 
equations  of  those  three  previous  sections  and  develop  a 
system  of  equations  that  feature  the  target  as  the  plant  and 
the  satellite  as  the  observer.  It  would  of  course  greatly 
facilitate  the  observability  analysis  if  both  the  plant  and 
observer  for  the  system  could  b€  linear,  and  take  the  form 

x(t)  =  Ax(t)  ♦  B u ( t)  , 
y(t)  =  Cx(t). 

In  that  case,  the  observability  study  of  Chapter  IV  would 
become  straightforward,  and  this  aspect  of  this  problem 
would  no  doubt  have  been  fully  explored  years  ago. 
Unfortunately,  as  the  complicated  angular  rotations  and 
spherical  geometry  ox  Chapter  II  portend,  there  is  no  real¬ 
istic  way  to  pick  variables  sc  that  the  problem  will  be 
fully  linear.  It  remains  then  to  experiment  with  either  a 
linear  plant  and  nonlinear  observer,  or  vice  versa;  it  would 
ultimately  be  advantageous  to  avoid  if  p  jssible  the 
completely  nonlinear  system  described  by 

x(t)  =  F{x(t)  ,u(t),t), 
y(t)  =  H  (x(t)  ,t)  . 
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On  the  other  hand,  af  rate  data  is  not  immediately  avail¬ 
able,  the  next  position  observation  is  required,  and  the 
velocities  at  time  k  are  approximated  by 


V,(k.V  fvM  *  no) -ft 0-1 

\j(  M  --  eCv4'  -  gjjgl 
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(3.3} 


in  either  case 


and  course 


,  then  velocity  \J  -  |  t 


<^>  -  TAN*’ 


as  shown  in  Figure  3.2  .  For  an  aircraft  flying  at  constant 
altitude,  hT  will  be  zero;  for  a  surface  target,  both  hT  and 
h^  will  be  zero.  Otherwise,  this  first-order  model  allows 
for  nonzero  velocities  in  the  n,  e,  and  hT  directions.  To 
avoid  the  necessity  tc  include  any  higher  order  variables  in 
the  target  description,  the  mcdel  will  represent  accelera¬ 
tion  as  the  control  vector  u(t)  in  all  further  discussion  of 
the  target's  performance. 


B.  SATELLITE  DATA  OBSERVED  FROK  TARGET  HOTIOH 

Thus  far,  the  result  of  the  discussion  in  Sections  IID, 
HE,  and  IIIA  of  this  report  effectively  has  been  to  develop 
an  algorithm  for  describing  the  motion  of  a  near-earth 
target,  given  the  parameters  of  the  orbit  of  the  tracking 
satellite  and  the  observed  target  data.  No  matter  what 
method  of  analysis  is  employed,  however,  any  observability 
study  requires  first  a  target  mcdel,  and  then  some  series  of 
observations  based  on  target  behavior;  therefore  it  now 


Figure  3.1  Earth's  Surface  Projected  onto  Cartesian  Grid 


compute  the  velocity  components  if  they  are  not  readily 
available.  If  the  earth's  surface  is  projected  upward  onto 
a  Cartesian  Grid  with  its  origin  at  (L,  \  )  =  (3,0)  as  in 
Figure  3.1,  then  a  position  (n,e,hT)  would  be  described  by 
equations  3.1,  with  hT  unchanged  from  Chapter  II. 

n  - u 


e  -  x"a  coslt 


(3.1) 


If  rate  data  is  available  from  the  satellite,  then  the 
northerly  and  easterly  velocity  components  are  computed 
simply  by  differentiating  equations  3. 1  with  respect  to 
time;  obviously,  h^  is  once  again  as  in  Chapter  II. 
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III.  TARGET  MOTION 


It  is  henceforth  assumed  that  the  satellite’s  position 
and  orientation  in  space  are  known,  and  thus  observed  target 
data  can  be  translated  into  ground  coordinates  in  accordance 
with  the  discussion  presented  in  the  last  two  sections  of 
Chapter  II.  This  leaves  the  problem  of  recons tructing  the 
target’s  motion  from  the  observed  data.  With  an  eye  toward 
the  observability  analysis  upcoming  in  Chapter  IV,  an  effort 
will  be  made  to  employ  a  linear  target  model,  while  the 
observations  will  be  necessarily  highly  nonlinear.  The 
alternatives  would  be  nonlinear  eguations  describing  both 
the  target's  motion  and  the  observation,  or  a  nonlinear 
plant  with  a  linear  observation  achieved  by  another  coordi¬ 
nate  transformation,  both  of  which  would  only  further 
complicate  the  problem  at  this  point.  They  do  present 
viable  possibilities,  however,  which  might  be  investigated 
as  part  of  a  search  for  convenient  coordinates  conducive  to 
appropriate  nonlinear  obser vability  analysis  and  tracking 
design. 

A.  TARGET  MOTION  RECCNSTROCTED  PROM  SATELLITE  DATA 

In  Chapter  II,  algorithms  were  developed  for  trans¬ 
forming  raw  satellite  sensor  information  into  ground  coordi¬ 
nate  data;  given  range  and  bearings,  the  computational 
result  is  target  latitude  and  longitude.  If  range  and 
bearing  rate  information  is  also  available,  the  result  is 
then  latitude  and  longitude  rates. 

To  reconstruct  the  target’s  motion  from  this  information 
is  fairly  straightf  orw?  _  d.  The  first  step  is  to  translate 
the  latitude  and  longitude  into  linear  distances,  and  then 


4  3 
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11  -v- 


This  completes  the  description  of  the  recorded  data 
available  from  the  orbiting  satellite  and  its  observation  of 
a  near-surface  target.  The  next  chapter  is  devoted  to 
reconstructing  the  target's  motion  from  this  information; 
this  will  then  lead  to  the  observability  analysis  of  Chapter 


Having  transformed  the  raw  rate  data  to  the  reference  coor¬ 
dinate  rates  with  equations  2.  2 4  through  2.26,  these  rates 
are  then  translated  to  earth’s  surface  coordinates  by 
differentiating  equations  2.17  through  2.23  . 

Then,  from  2.17  (surface  target). 


from  2. 18  , 
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from  2.19  (air  target). 
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and  from  2.21  through  2.23  , 
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These  equations  2.24  through  2.31  completely  define  the 
derivation  of  target  latitude  and  longitude  rates  based  on 
raw  angular  and  range  rate  data  available  at  the  satellite. 
If  applied  sequentially  by  a  computer,  the  target’s  rate  of 
travel  could  easily  be  calculated. 


This  gives  rate  of  change  of  the  target’s  coordinates 
referenced  to  the  satellite's  axes  and  based  on  the  target's 
motion;  if  the  satellite  can  instantly  fix  its  position  in 
space,  then  x-y-z  can  be  transformed  to  N-E-D  by  applying 
the  transformation  equation  2.  13  to  correct  for  satellite 
attitude.  If  the  satellite's  own  rate  of  rotation  around 
its  three  axes  is  taken  into  account,  however — i.e.  the 
satellite  is  tumbling  fast  enough  to  affect  significantly 
the  observed  angular  rates--then  that  transformation  2.13 
must  also  be  differentiated,  i.e. 
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In  the  next  step,  equations  2.15  are  differentiated  to 


obtain 
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(2. 26) 


and  finally 
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1  •  V  -  4 


\T  *  7t.  (2.23) 

It  should  be  emphasized  that  both  latitudes  are  referenced 
North  here,  and  both  longitudes  East.  To  switch  to  south 
latitude  and/or  west  longitude,  one  need  only  know 

For  N  Lat  <  0,  S  Lat  =  -N  Lat  ; 

For  E  Long  <  0,  W  Long  =  -E  Long; 

For  E  Long  >  180,  W  Long  =  360  -  E  Long. 

Sample  calculations  using  these  equations  reveal  that  it 
takes  a  significant  amount  of  target  elevation  to  generate 
an  appreciable  change  in  /3 ,  i.e.  at  a  range  of  1000  nm  from 
a  satellite  at  elevation  600nm,  a  target  flying  at  25000  ft 
would  have  a  j6  angle  only  0.2°  different  from  that  of  a 
surface  target.  Therefore,  depending  on  its  sensitivity, 
the  satellite  sensor  may  or  may  not  distinguish  betwen 
target  types,  if  dependent  or  a  single  look  at  position 
only.  The  necessarily  greater  speed  of  the  air  target, 
however,  will  ultimately  become  obvious  if  the  satellite 
system  is  either  capable  of  calculating  range  and  bearing 
rates  based  on  multiple  observations,  or  else  rate  informa¬ 
tion  is  an  intrinsic  part  cf  the  single  observation. 
Therefore,  this  model  must  provide  for  the  satellite’s 

•7  0  C 

ability  to  observe  R ,  oc.  ,  and  in  addition  or  as  opposed 
to  H ,  oC  ,  and  A  .  The  transformation  equations  2.14  through 
2.23  must  then  be  differentiated  with  respect  to  time  to  get 
the  range  and  bearing  rates  referenced  to  N-E-D,  and  then 
the  target’s  latitude,  longitude,  and  altitude  rates. 

Differentiating  equations  2.14, 

^  -  R  *  ft  4  it,  ^ 

12-  - 


(2.24) 


Figure  2.16  Surface  Triangle  for  Target  Position 


and  longitude  may  be  calculated  by  using  the  spherical 
triangle  shown  in  Figure  2. 16  .  Using  the  law  of  cosines 
for  spherical  triangles,  and  realizing  now  that  it  is  actu¬ 
ally  more  convenient  to  work  with  ear th-central  angles 
rather  than  great  circle  distances,  then 
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Similarly, 
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cr,  solving  for  K  , 


7t  =  cos 


Cos^j  —  'SvM  Ut 
Cos  l-t  CcS  Li 


(2. 22) 


38 


B 


i 

- 

* 

A 


O  \  cocci 

oool 

C  c  c  o  c  o 

'CO 

O  C  o  '  CO 
q  o  coco 

Xlfc'j  r 

coo 

O  4  c 

C  O  c  c  C  i 

oco 

o  O  C  c  cc 

DO  \  _ 

uUV;  --  y\  (v  tOW 

»  _  /w 


ii  (v^\ 

x  (x(a 
^  C  xca 
^  (van 


f  _  n 

h  '  re  >  UT  r„ 

i  _  e  Vo  e u-stT  v  Ue  v^-t 

Y„  Gi^  Wi  ;  T  V„  COST1  L r 

7 C  ^  \T'  Ns  ,  7C  -  XT  -  Ns 

5=  O-S'1  |V»mL-{  Stvit4  +  CO»lq  Ct.i  L$ 

J  •=  —  w  (s,MLTC^LiCcix-cc^TSv^LsVvXCcSCTcc-sLs^,NX 

/  Sv.'y)  I  \“ 

•*-  a  (ccv.Lt  S«~Ls  CcSTt  -  Vt,M  Ir  C^S  U  } 

Hl - <Z. ^  i|CroTWV+  -z(r4rWYf»rU^  cxyJj 

Uz-  i  --  X [  ^[p.-vA -0*a «-y]  '/>  (voV^vCs* 


Hj=-oC=  5'" 


CcVLf  S'^'X. 


S'fO 


/ 


jt  ' 


to. 


t 


x  CujCx^X'^T  Sl*J  Lf  SinIXJ  — />  cost]"  ^'^7C 


3-/ 


/> 


vAc,  s  /3  ~  Cc-v 


co>x.  %>>*y,u 
ft1*  (r.-UV-(v„,U^ 


>V*  /  -‘ 


3  iZ-  (  ft* » Ui^ 

"2-^- (  V"e -r  V\r  )  Ur  —  R  —  (_'f."rV'sl  t  (  V’W)*) 
L^R*~  C  rc  i 


Figure  3.3  Suaaary  of  State  and  Observer 
Equations  Including  Intermediate  Variables 


3.  Two  Simpler  Cases 

The  significant  complexity  of  these  equations 
suggests  that  some  simpler  representation  of  the  system 
might  he  useful  in  the  observability  analysis,  if  only  to 
test  the  method  prior  to  its  employment  on  the  system  of 
Figure  3-3  .  One  approximati or  might  be  to  presume  for  the 
moment  that  the  satellite  is  directly  overhead  the  target, 
and  that  relative  motion  between  J  hem  is  arbitrarily  small 
enough  that  the  Earth  is  approximately  planar  beneath  it; 
for  the  trigonometric  functions, 

T/W/S  =  w/3  =/3  and  ccs.^=  l. 
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Figure  3.4  Satellite  Directly  Overhead  the  Target 

If  one  considers  that  for  a  satellite  directly  over¬ 
head  the  target  as  shown  in  Figure  3.4, 

W®  U,  XT  -  As<  and  WT  -  -  ft  . 
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Figure  3.5  Perturbation  About  the  Observation 
From  Direct lj  Overhead 


Figure  3.6  fiesolution  of  Beta  Along  the  N-E  Axes 


then  fcr  a  satellite  nearly  overhead  the  target,  the  probxem 
can  be  considered  as  a  perturbation  about  the  directly  over¬ 
head  case.  In  Figure  3.5,  let 


(3.  17) 
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To  fully  linearize  the  problem  ,  it  turns  out  that  musl 
be  eliminated;  this  can  be  done  (in  this  special  case  only) 
as  shown  in  Figure  3.6: 
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Now  the  observation  may  be  defined  by 
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and  the  corresponding  discrete  system  plant  is 
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with  the  same  observer  matrix  as  above  but  with  values  taken 
only  at  discrete  points  in  time. 

Experimental  computations  show  that  for  a  satellite 
at  altitude  600nm  and  a  target  at  less  than  60v'  latitude, 
these  approximations  yield  about  one  percent  error  or  less 
for  $  less  than  5°;  however,  the  maximum  possible  over¬ 
head  time  during  which  this  model  applies  is  about  20 
seconds.  It  follows  then  that  this  sort  of  observation 
could  only  be  made  a  very  few  times  during  the  satellite's 
revolution,  severely  limiting  the  real-world  usefulness  of 
this  linear  model.  For  the  purpose  of  examining  the  observ¬ 
ability  of  the  target  under  these  conditions,  however,  the 
model  should  still  prove  guite  useful. 

The  other  simplified  model  that  might  be  instru¬ 
mental  in  gaining  some  insight  into  the  method  of  the 
observability  analysis  is  the  simplest  nonlinear  case,  i.e. 
the  satellite  tracking  a  fixed  point  on  the  earth's  surface. 
Simplifying  the  eguations  3.5  through  3.16  yields  the  system 
depicted  by  the  eguations  in  Figure  3.7 

This  completes  the  various  derivations  for  all  the 
target  models. 
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IV.  TARGET  OBSERVABILITY 


This  Chapter  is  subdivided  into  three  major  sections, 
specifically  the  observability  analyses  of  the  three 
different  target  models  developed  in  Chapter  III.  First, 
the  linearized  model  will  be  analyzed  by  the  method  of 
[Ref.  2]#  and  then  the  stationary  target  and  the  general- 
case,  nonlinear,  moving  target  will  be  analyzed  by  the 
method  developed  in  £Ref.  1], 


A.  OBSERVABILITY  OF  TRE  LINEARIZED  MODEL 


For  convenience1  sake,  the  linearized  model  has  been 
subdivided  into  four  cases,  namely  surface  and  air  targets 
with  discrete  and  continuous  modeling  for  each.  The  method 
of  [Ref.  2 ]  is  the  formation  of  the  observabilit y  matrix  £ 
from  the  system 


x  =  Ax  +  Bu 

—  a.—  — 


y  =  Cx 


such  that 
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for  n  observations,  and  for  system  observability,  G  must  be 
nonsingular.  In  the  following  derivations,  the  minimum 
amount  of  information  necessary  for  observability  is 
considered. 


1  •  Surface  Target  Continuous  Mo  del 


The  system  model  is 
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For  a  single  look. 
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For  the  next  observation,  AT  =  0,  so  there  is  no  need  to 
take  the  process  any  further.  If  only  position  observ¬ 
ability  is  desired,  rather  then  full  state  observability, 


then 


.  A 


is  enough  even  for  only  a  single  observation. 
2.  Surface  Target  Discrete  Model 
Now  the  system  model  is 
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which  simplifies  easily  to  the  same  nonsingular  matrix 
obtained  in  the  analogous  continuous  case. 

Obviously  for  this  simplified  case,  the  transition 
from  continuous  to  discrete  modeling  made  no  difference;  it 
has  been  implicitly  assumed  that  the  discrete  samples  are 
taken  often  enough  that  all  maneuvers  (i.e.  accelerations) 
are  observed,  in  accordance  with  the  Sampling  (or  Shannon 
Information)  Theorem  familiar  from  communications  applica¬ 
tions.  Otherwise,  observability  will  decrease  significantly 
as  information  about  the  target  is  lost. 


3*  Air  Target  Continuous  Model 
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The  system  is  now  modeled  by 
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is  required,  and  G  =  as  in  the  surface  target  cases, 
two  or  more  looks, 
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for  complete  observability.  As  in  the  surface  case,  if 
position  observability  is  desired,  then 

A 

- 

is  adequate  even  with  only  the  single  observation. 

4.  Air  Target  Discrete  Model 
The  model  has  now  become 
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is  required,  and  as  expected,  G  =  Cl  again.  For  two  or  more 
looks  , 
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is  needed,  and 
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which  simplifies  to  the  same  tonsingular  matrix  as  in  the 
continuous  case.  Again,  the  assumption  has  been  made  that 
information  is  sampled  at  the  minimum  (i.e.  Nyquist)  rate, 
which  is  twice  as  often  as  the  target's  highest  frequency  of 
mane  uver. 


B.  SCN1IHEAR  BODEL  OF  THE  STATIONARY  TARGET 


Applying  the  method  of 
briefly,  concerns  primarily 
matrix  defined  by  r 
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£Re£.  1],  summarized  here 
the  analysis  of  a  Jacobian 
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for  each  observation  of  an  n-system.  A  nonzero  determinant 
will  show  that  all  the  states  i  r.  x_  are  connected  to  at  least 
one  of  the  measurements  y,  and  so  an  inverse  function  exists 
such  that 
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w 


x  =  H  '  (y) . 

For  observability,  however,  this  mapping  of  y  back  into  x 
must  be  one-to-one,  so  that  a  particular  series  of  measure¬ 
ments  y  will  always  determine  a  unique  initial  state  x  (tu )  . 
This  requirement  is  satisfied  if  a  second  condition  is  met, 
i.e.  J  must  be  positive  or  negative  definite,  and  the 
mapping  unique  with  finite  covering.  The  complete  procf  of 
these  concepts  is  presented  in  [Ref.  1]  and  [Ref.  7].  For 
multiple  observation  variables  (i.e.  numbering  m) ,  an  n  x  mu 
matrix  is  formed;  if  any  n  x  n  matrix  can  be  extracted  that 
satisfies  these  conditions,  the  system  will  be  observable. 
For  the  six- variab ie,  six-observation  case  upcoming  in 
Section  C  of  this  chapter,  this  will  lead  to  a  great  many 
possibilities  and  problems,  but  for  the  two-variable  case  of 
this  section,  the  method  should  prove  very  useful.  The 
approach  will  be  to  first  consider  each  observation  sepa¬ 
rately,  and  then  in  combination. 

Starting  from  the  equations  for  the  observation  of  the 
stationary  target  depicted  in  Figure  3.7,  derivation  of  the 
Jacobian  matrix  for  y  =  R  is  accomplished  by  means  of 
implicit  differentiation  along  the  lines  of  functional 
dependency  depicted  in  Figure  4.1  .  Consider 
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Figure  4. 1  Functional  Helaticnship  of  8  and  8  to  n  and  e 
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which  is  obviously  nonzero  in  the  general  case  but  may  well 
have  multiple  solutions.  Eased  on  the  criteria  just 
defined,  this  indicates  that  bcth  states  in  x  are  connected 
to  the  observation  R,  but  the  connection  may  very  well  not 
be  one-to-one;  some  further  analysis  is  obviously  required. 

The  determinants  of  the  J- matrices  for  each  of  the  other 
observed  variables  may  well  prove  similarly  ambiguous; 
considering  the  observed  variables  in  combination  and 
attempting  to  establish  nonsingularity  and  positive/negative 
definiteness  of  the  resultant  myriad  of  Jacotians  may  well 
prove  difficult  in  the  extreme,  if  only  in  the  sense  of 
requiring  a  copious  amount  of  confusing  algebra.  While  the 
basic  geometry  of  the  problem  as  developed  xn  Chapter  II 
leads  one  intuitively  to  the  conclusion  that  a  surface 
position  can  be  uniquely  established  if  either  (oL ,  A  )  or 
(E,  oC  ) --but  not  (R ,  jA) — data  are  available,  demonstrating  it 
by  this  method  proved  a  mammoth  computational  undertaking. 
Needless  to  say,  when  the  problem  is  expanded  to  the  four 
variables  of  the  moving  surface  target  and  then  the  six 
variables  of  the  air  target,  the  algebra  worsens  several 
times  over.  The  only  alternative  seemed  to  be  a  transforma¬ 
tion  of  coordinates,  specifically  to  a  rectangular  system, 
so  that  the  differentiation  could  include  some  polynomials 
instead  cf  only  trigonometric  functions.  The  transformation 
is  accomplished  as  fellows:  establish  a  plane  at  a  distance 
equal  to  (hs  -ht)  below  the  satellite  perpendicular  to  the 
vector  connecting  the  satellite  to  the  earth's  center, 
determining  in  effect  the  target's  horizon.  For  a  surface 
target,  the  point  of  intersection  is  the  satellite's  ground 
point;  for  an  air  target,  the  intersec tion  is  h  above  the 
ground  pcint.  Then  the  target's  position  is  projected  up 
into  the  tangent  plane,  as  shown  in  Figures  4.2  (a)  and  (b)  . 
It  is  now  possible  to  establish  the  relative  coordinates  as 
follows: 


i= 


a.  nw 

or  x  =  Fx  where  F  =  A  -  C\ 


(5.9) 


The  solution  to  equation  5. 9  is 


-  e.  ~  ^  ) 


(5.  10) 


which  converges  for  any  F  with  negative  real  eigenvalues. 

For  the  time-invariant  linear  case  where  H  is  a  constant 
matrix,  a  unique  G  matrix  exists  for  any  desired  set  of 
negative  eigenvalues  of  F;  however,  for  the  general  case, 
since  obviously  varies  with  state  and  time,  G  must 
generally  be  a  time-varying  or  state-varying  function.  Thus 
the  problem  remains,  how  to  calculate  G.  Many  methods  have 
been  demonstrated  for  the  case  of  the  time-varying  linear 
observer  which  could  be  extended  to  cover  this  linearized 
case;  the  method  of  choice  here,  however,  will  be  the  SKF , 
which  requires  some  preliminary  discussion  prior  to  its 
employment. 


B.  EXTENDED  KALMAN  FILTER — BACKGROUND 

Both  [Ref.  3]  and  [Ref.  8]  discuss  the  analysis  origi¬ 
nally  employed  by  Kalman  and  Bucy  to  develop  the  linear  case 
and  the  so-called  Extended  Kalman  (nonlinear  case)  filter. 
It  suffices  here  to  state  that  the  theory  applies  to 
stochastic  systems,  rather  than  the  perfectly  deterministic 
system  considered  thus  far,  and  involves  perturbation  about 
a  linearized  estimate  of  the  target  track  in  the  same 
fashion  as  Section  A  above. 


c))A| 

Cx-v^)  ' 

(5.4) 

Now,  since  the 

method  of 

[  Ref. 

8  ]  assumes  th at 

only  the 

measurements  y  are  available,  the  plant  matrix  must  be  simu¬ 
lated  by  the  observer  to  generate  successive  estimates,  i.e. 

x  =  Ax  ■  (5.5) 

However,  unless  the  estimates  are  coincidentally  initialized 
to  values  identical  to  the  initial  conditions  of  the  actual 
system,  there  will  be  an  inherent  propogation  error. 
Therefore  a  correction  term  must  be  added  to  equation  5.5  as 
follows : 

X  =  Ax  +  G  (H  (x)  -  H  (x)  )  #  (5.6) 

where  G  is  the  observer  gain;  the  determination  of  G  will  be 
discussed  shortly.  Equations  5.1  through  5.6  can  be  illus¬ 
trated  by  the  block  diagram  of  Figure  5.1  . 

To  evaluate  G,  the  first  step  is  to  substitute  equation 
5.4  into  equation  5.6  so  that 


/V 


-  <s^L  cx-iV 


(5.7) 


It  becomes  useful  to  define  the  error  in  x  as 

X  =  x  -  x  ;  (5.8) 

x  is  defined  by  subtracting  eguation  5.7  from  equation  5.3, 
i.  e. 


'X'  °  S'  ,  .  A 

X  =  x  -v  =  Ay.-  Anl  - 
^  - 

Substituting  equation  5.8 


where  applicable 
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(5.2) 


Ignoring  the  higher  order  terns  and  assuming  for  the  moment 
a  constant  velocity  target,  the  linearized  system  can  new  be 
described  by 


x  =  Ax 


(5.3) 
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V.  FILTERING  AND  TRACKING 


The  objective  of  this  chapter  is  to  apply  the  results  of 
Chapter  IV.  Specifically ,  this  will  entail  designing  a 
deterministic  nonlinear  observer,  and  then  an  EKF,  in  accor¬ 
dance  with  the  methods  discussed  in  [Ref.  3]  and  [Ref.  8]. 
The  original  coordinates  of  the  problem  as  developed  in 
Chapters  II  and  III  will  be  employed,  rather  than  the 
rectangular  coordinates  of  Chapter  IV. 

A.  DETERMINISTIC  NONLINEAR  OBSERVER 

Actually,  in  [Ref.  8],  Kirk  only  discusses  the  design  of 
linear  observers,  but  by  employing  the  now-familiar  tech¬ 
nique  of  linearizing  about  an  estimate  with  a  first-order 
Taylor  Series  expansion,  the  technique  can  readily  be 
extended  to  a  nonlinear  system.  Some  alternative  methods  of 
nonlinear  observer  design  are  discussed  in  [Ref.  S], 
[Ref.  10],  [Ref.  11],  and  [Ref.  12]. 

For  the  system  under  consideration. 


x  =  Ax  +  Eu  ,  y  =  H  (x)  (5.1) 

— *  A-  —  —  J*-  —  ) 


where 


i  o  o  o  o 
o  c*  C.  o 

O  O  V  o  O 
o  O  C,  C  o 

o  o  O  c  \ 
o  o  o  Co 


Assuming  an  observer-estimated  trajectory  x,  the  observation 
is  linearize!  around  it 


insights;  then  the  examination  of  the  stationary  surface 
target  led  to  the  coordinate  transformation/  and  to  the 
conclusion  that  any  position  variable  of  observation  would 
suffice  for  observability  of  this  type  target. 
Consideration  of  the  general  target  model  showed  it  to  be 
unobservable  for  any  single  variable  of  observation,  and 
then  a  brief  examination  of  the  moving  surface  target  led  to 
the  important  conclusion  that  an  o(  -only  track  is  possible, 
at  least  if  the  target  maneuvers.  Further,  it  appears  that 
the  system  is  far  more  sensitive  to  fluctuations  (i.e. 
noise)  in  the  measurements  than  E  or  ^  .  In  Chapter  v 
some  cf  these  perceptions  will  be  tested  by  the  designing  of 
a  deterministic  nonlinear  observer  and  then  tracking  the 
target  with  an  EKF. 


some  ambiguity  in  the  observations  and  so  the  target  is  not 
observable.  In  the  case  of  the  o(  Jacobian,  however,  it  is 
positive  definite,  i.e.  the  JL  terms  drop  out  and 

*  (ea^-TNae)  (4.5) 

This  indicates  that  a  maneuvering  surface  target  is  observ¬ 
able  when  azimuthal  bearings  only  are  observed;  this  case 
corresponds  very  closely  to  the  two-dimensional  bearing-only 
tracking  problem  long  familiar  to  submariners.  If  the  target 
does  net  maneuver,  then  the  Jacobian  becomes  non¬ 
singular  and  the  target  is  unobservable,  and  then  more  than 
one  variable  of  observation,  to  include  or  oC  ,  is 
required  for  observability. 

It  becomes  obvious  why  the  observability  of  nonlinear 
systems  has  long  been  considered  a  highly  difficult  problem. 
At  least  as  much  insight  was  gained  into  the  problem  from 
its  mathematical  derivation  as  from  the  application  of  this 
method  of  observability  analysis.  One  area  in  which  the 
method  might  also  be  useful  is  in  evaluating  the  sensitivity 
of  the  system  observability  to  fluctuations.  Specifically, 
the  terms  in  the  $  Jacobian  are  each  smaller  than  the  <x.  or 
R  terms  by  a  factor  of  I/In'1 +ex  ,  which  would,  in  the  general 
case,  mean  a  difference  of  three  orders  of  magnitude.  This 
would  certainly  lead  cne  to  presume  that  the  system  would  be 
more  sensitive  to  fluctuations  in  /j  than  in  E  or 

To  summarize  thus  far,  the  geometric  derivation  of  the 
coordinates  in  Chapter  II  leads  one  to  believe  that  ail 
three  coordinates  R,  o(.  ,  and  /$  ,  or  the  derivatives  of  no 
more  than  two  of  them,  are  necessary  to  reconstruct  the 
target  motion  in  the  most  general  (air  target)  case,  while 
either  the  (R,o<:  )  or  (iX,/3  )  combination  is  necessary  and 
sufficient  for  the  surface  target.  Examination  of  the 
linearized  model  in  this  chapter  tended  to  validate  those 
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Figure  4.6  Jacobian  Obserrer  Matrices 
For  the  Six  State  Variables 


well  be  possible,  but  these  representations  should  suffice 
here.  It  is  obvious  from  the  occurence  of  the  zero  rows  and 
columns  that  all  the  determinants  excluding  those  of  J(^  and 
Ja  are  zero;  computation  of  these  last  two  determinants 
proves  them  to  be  zero  also.  Considering  the  observed  vari¬ 
ables  in  combination,  it  would  seem  that  some  variable  in 

0 

addition  to  R  or  R  is  always  necessary  for  observability,  as 
they  have  the  only  Jacobian  matrices  with  zero  rows.  FLile 
the  possible  combinations  of  six  columns  out  of  the  thirty- 
six  are  so  numerous  {approximately  two  million)  that  it  is 
virtually  impossible  to  explore  them  all,  only  one  combina¬ 
tion  with  a  nonzero  determinant  and  positive  or  negative 
definiteness  is  required  for  observability. 

What  one  would  expect,  based  on  the  insight  gained  in 
Chapters  II  and  III  from  the  mathematics  of  the  derivation 

of  the  model,  is  that  any  combination  including  oL  or  oL  and 

*  • 

at  least  one  position  variable  (i.e.  R  and  oL  ,  oC  and  />  , 
etc.)  should  be  observable,  and  that  any  determinant  formed 
from  a  combination  of  columns  from  the  appropriate  J 
matrices  should  prove  it  {excepting  of  course  the  zero 

0 

columns  in  the  o£  and  oi  matrices)  .  The  combinations  or 
•*  .  • 

E,  R,  ,  and  /A  should  however  prove  unobservable  for  the 
reason  of  a  lack  of  positive/negative  definiteness,  that  is, 
an  ambiguity  of  target  track  resulting  when  reconstruction 
of  the  initial  state  is  attempted  from  the  measurements.  To 
prove  this  condition  true  for  each  of  the  approximately 
130,000  possible  matrices  is  however  obviously  an  unreal¬ 
istic  undertaking. 

One  slightly  simpler  case  cf  particular  interest  might 

be  that  of  the  surface  target,  which  involves  the  first  four 

rows  by  four  columns  in  each  matrix.  If  the  accelerations 

* 

are  ncnzero,  all  the  Jacobians  except  R  have  nonzero  deter- 

**  r 

minants.  The  R,  ^  ,  and  determinants  are  not  posi¬ 

tive  or  negative  definite,  indicating  that  there  is  still 


(4.4) 
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So  again  the  same  form  of  determinant  will  be  achieved, 
albeit  with  a  different  multiplicative  constant.  Thus  for  a 
target  known  to  be  stationary,  the  observation  ox  any  of  the 
quantities  E,  (X.  ,  or  is  enough  to  fix  its  position. 
Presumably  the  same  result  could  have  been  achieved  ir.  the 
original  coordinate  system  had  the  algebra  been  carried 
through. 


C.  HCHLINEAR  MODEL  OP  THE  GENEIAL  TARGET 


Once  the  target  is  permitted  to  move,  of  course,  the 
unique- intersection  arguments  just  developed  no  longer 
apply.  The  equations  shown  in  Figure  4.3  now  are  pertinent, 
but  J  is  defined  by 
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The  derivation  of  the  Jacobian  matrices  and  their  determi¬ 
nants  is  now  a  major  project  ir.  itself,  but  it  follows  the 
same  pattern  previously  established.  In  the  interests  of 
brevity,  the  requisite  algebra  is  excluded  from  this  discus¬ 
sion,  but  included  in  this  report  as  Appendix  A.  After 
simplification  by  row  reduction,  the  J  matrices  are  as  shown 
in  Figure  4.6  ,  with  the  and  ^  terms  as  specified  in  the 
appendix.  Further  simplification  of  the  determinants  may 


Consider  first  the  ,^-only  case: 
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The  numerator  is  identical  to  that  of  the  J . 
Figure  4.5  illustrates  the  situation  here. 
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determinant 


Figure  4.5  Azimuthal  Bearing-Only  Track 
Of  the  Stationary  Target 
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Figure  4,4  Tracking  the  Stationary  Target 

The  satellite’s  ground  track  is  a  curve,  and  there  is 
only  one  possible  point  of  intersection  of  even  three 
circles  whose  centers  lie  upon  it.  This  observability  will 
be  more  clearly  demonstrated  if  the  single  observed  variable 
to  the  stationary  target  is  o(  ;  obviously,  the  intersecting 
lines  of  bearing  must  define  a  single  point.  Further,  since 
for  a  surface  target  every  H  defines  a  unique  and  vice 
versa,  the  A  -only  case  should  he  observable  also. 


Figure  4.3  State  and  Observer  Equations 
For  the  Cartesian  Version  of  the  Problem 


(4.2) 


which  is  again  nonzero  in  the  general  case,  and  which  will, 
on  reflection,  lead  to  a  unique  solution  for  any  particular 
target  and  a  specified  satellite;  in  fact,  equation  4.1 
should  then  also  yield  unique  solutions,  not  just  due  to  the 
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Figure  4.2  Projecting  Target  Position 
Into  a  Perpendicular  Plane 

As  every  set  of  true  target  coordinates  yields  a  unique  set 
of  relative  coordinates  for  a  particular  satellite,  the 
mapping  into  the  Cartesian  coordinates  is  one-to-one,  and  an 
observable  target  in  one  systea  will  te  observable  in  the 
other.  The  complete  set  of  state  and  observer  equations  in 
this  coordinate  system  is  as  illustrated  in  Figure  4.2  (b) 
and  summarized  in  Figure  4.3  .  For  the  special  case  of  the 
stationary  surface  target,  the  system  simplifies  as  follows: 
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vhere  w  is  system  noise,  and  v  is  measurement  noise.  It  is 
important  to  note  that  the  form  of  the  observer  has  not 
changed  since  the  discussion  ic  Section  A  of  this  chapter; 
now,  however,  the  filter  analysis  provides  a  method  for 
calculating  the  sequence  of  gait  matrices  G. 

That  last  statement  concerning  a  sequence  of  G’s 
suggests  the  convenience  of  a  discrete  (as  opposed  to 
continuous)  representation  of  the  system.  Considering  that 
the  iterative  calculations  required  to  compute  the  succes- 

A  . 

sive  estimates  x  will  require  a  measurably  finite  time- 
increment,  it  makes  sense  to  work  with  the  discrete  system 
equivalent  to  the  continuous  system  discussed  thus  far,  i.e. 


x(k  +  1)  =  <|x(k)  ♦  £w(k) 
y(k)  =  H(x(k)>  ♦  v  (k)  ( 


(5.13) 
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That  is,  both  the  system  and  observer  noises  are  presumed  to 
be  white  independently  normally  distributed  with  mean  zero 


and  specified  variances#  which  are  independent  of  the 
Gaussian  random  variable  x (0)  -  Ihe  observer  equation  5.6 
will  take  the  form 

V\  (>(  *\)  -  U  (5.15) 

A.  "*  •%. 

- 

It  is  now  useful  to  introduce  the  double-subscripted  nota¬ 
tion  required  to  compute  the  G  (k)  matrices  in  the  EKF  algo¬ 
rithm,  i.e. 

x(kjk-l)  # 

which  signifies  an  estimate  at  time  increment  k  based  on 
information  available  at  time  increment  k-1,  as  opposed  to 

x  (k  |  k) 

—  i 

which  represents  the  estimate  at  time  k  given  the  informa¬ 
tion  available  at  time  k. 

The  final  element  required  to  understand  the  EKF  algo¬ 
rithm  is  the  concept  of  the  error  covariance  matrix  E[k) , 
which  can  also  be  thought  of  as  the  expected  value  of  the 
error  vector  squared,  i.e. 

P(k)  =  E{(x)x). 

Its  derivation  and  significance  is  fully  explained  in 
[Ref.  8],  while  [Ref.  3]  discusses  at  length  its  initializa¬ 
tion.  Suffice  it  here  to  state  that  it  is  an  intrinsic  part 
of  the  EKF  algorithm,  which  can  now  be  summarized. 

Given  the  state  estimate  and  covariance  matrix  at  time 
k-1  and  the  measurement  at  time  k,  the  state  and  covariance 
at  time  k  are  estimated  as  follcws: 

x(kjk-l)  =  v  (Vi  (v.-i') 


(5.  16) 


P(kjk-I)  =  $  £  »•  [  QpT, 


(5.17) 
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The  EKF  gain  matrix  is  then  calculated  as  follows: 
G  (k)  =  P(K\k.-\^  UTM  P  CW-\W-^  \\CA  ■*  ) 


(5.  18) 
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Finally,  the  state  vector  and  the  covariance  matrix  are 
updated  as  follows: 


x{kjk)  =  b  ^  “  VJ  (x  CwVw-iJ\| 

p{xik)  =  1“6W.uck{|pw^ 


(5.  19) 


(5. 20) 


All  that  remains  is  the  guestion  of  initialization;  [Ref.  3] 

develops  fully  the  method  used  to  initialize  both  the  state 

vector  and  the  covariance  matrix,  specifically  the  use  of 

the  first  two  target  observations  to  generate  initial  esti- 

mates  for  both  x  and  F.  This  method  is  illustrated  in  the 
— -  /*■ 

specific  example  that  follows  immediately. 

C.  TARGET  TRACKING  WITH  THE  EKI 

This  section  discusses  the  development  of  a  computer 
program  designed  to  implement  the  basic  Kalman-Bucy  filter 
algorithm  discussed  in  Section  B  above.  While  admittedly 
crude,  it  serves  as  a  first-cut  tracking  algorithm  and  can 


be  used  in  conjunction  with  the  observability  analysis  of 
Chapter  17.  The  problem  divides  itself  naturally  into  two 
parts,  namely  developing  models  for  the  satellite  and  the 
target;  and  then  using  the  EKF  algorithm,  that  is,  equations 
5.16  through  5.20,  to  see  if  the  satellite  can  track  the 
target. 

1 .  Satellite  and  Target  Models 

This  is  the  time  when  the  various  eguations  devel¬ 
oped  in  Chapter  II  (satellite)  and  Chapter  III  (target)  are 
necessary.  For  the  purposes  of  this  problem,  a  satellite 
with  an  altitude  of  600  nm  and  an  orbital  inclination  of 

O 

63.4  is  used,  as  this  is  a  typical  orbital  pattern  used  to 
ensure  whole-earth  coverage  in  a  multi-satellite  constella¬ 
tion.  A  surface  target  simplifies  the  problem  slightly,  as 
x  need  only  be  f our- dimensional ;  thus  the  target  chosen  is  a 
surface  vessel  on  a  heading  of  315°  at  a  speed  of  28.3 
knots,  which  equates  to  a  northerly  velocity  of  20  knots  and 
an  easterly  velocity  of  -20  knots.  At  time  zero  (i.e.  k=0)  , 
the  satellite  is  located  overhead  the  point  (g'’n,0  E) ,  while 
the  target  is  located  at  (45°  H,30CE),  which  is  initially 
below  the  satellite’s  horizon;  the  program  is  designed  to 
compute  (E,  oC.  $  /3  )  as  (0*0#  0)  until  the  target  comes  in 
view.  The  computer  program  listing  appears  in  Appendix  B; 
of  perhaps  greater  interest  is  the  data  which  appears  in 
Table  V,  which  shows  the  program  run  for  23  minutes  with  a 
time  step  of  30  seconds,  i.e.  k  running  from  0  to  56.  For 
this  single  pass,  the  target  was  in  view  for  117  steps  in 
time,  or  19.5  minutes,  a  fairly  representative  viewing  time. 

2 •  EKF  Operation 

In  the  main,  the  EKF  algorithm  used  in  the  computer 
program  that  appears  as  Appendix  B  is  the  direct  application 
ox  the  equations  5.16  through  5.20  to  the  particular 
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TABLE  ? 

Target  and  Satellite  Simulation  with  Observations 
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problem,  complete  with  the  intermediate  calculations 
required  to  evaluate  some  fairly  involved  matrix  multiplica¬ 
tions  and  inversions.  However,  two  aspects  of  the  program 
require  further  elaboration.  First,  the  filter  initializa¬ 
tion,  to  which  Section  B  of  this  chapter  alluded;  and 
second,  the  computation  of  the  Jacobian  observer  matrix  h, 
which  in  this  case  is  anything  tut  trivial. 

a.  Filter  Initialization 

The  method  developed  in  [Ref.  3]  has  been 
followed  exactly  here,  thus  a  two-point  initialization  is 
used.  Specif ically ,  the  northerly  and  easterly  positions 
calculated  from  the  observations  )  at  time  steps  0 

and  1  (i.e.  the  first  two  nonzero  observations)  are  the 

initial  estimates  for  and  x3  ,  and  from  them  the  initial 
velocities  are  computed,  i.e. 

■X.M-  y;'  (  R(cA,  jUe)(  , 

i,L»\  =  Hr ( K. (c), jUo),  /SO)), 

*■» 0\  --  (zCi),  t 

and  v.CA-'v.ft) 

- — - - -  , 

\ 

y,0\-  <5.2,, 

T 

From  these  calculations,  it  can  readily  be  shown  that  an 
initial  estimate  of  the  covariance  might  be 


p(i\^  H  '^/t1  °  ° 

oo  <Tv^  i 

°  1  /  (5.22) 

o  o  ^7j  ^Vj 

The  details  of  this  calculatior,  which  involve  taking  the 
expected  value  of  the  error  vector  squared  as  discussed  in 
Section  B  above,  appear  in  [  Bef  .  3].  While  it  could  be 
argued  that  other  methods  of  iritial  covariance  estimation 
are  available,  this  method  should  suffice  for  the  purposes 
of  this  analysis. 

This  completes  the  initialization  of  the  filter, 
and  from  time  step  ,,2,,  (third  nonzero  observation)  onward, 
the  filter  runs  according  to  the  algorithm  of  equations  5.16 
through  5.20  . 

b.  Observer  function  Matrix 

The  observer  function  h  is  defined  for  all  times 

k  as 
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(5.  23) 


Computation  of  the  matrix  elements  in  the  computer  program 
(Appendix  B)  is  performed  in  accordance  with  the  following 
derivation.  Consider  first  the  following  set  of  equations 
from  Chapters  II  and  III  that  summarizes  the  computation  of 
(E,  from  x  (surface  target  case): 


Cos^  = 
(2-  ' 
Si/si  oL  = 


5rd  Ls  +  CCS Lf  Cos CoiTc, 

cosLi  Swx^  . 

r‘s,^4. 


(5.24) 


Figure  5.3  Functional  Belationships  Between 
The  State  and  Observation  Vectors 

Obviously,  some  fairly  involved  chain-rule  differentiation 
will  te  required  to  compute  the  partial  derivatives  in  tne  h 


matrix  of  equation  5.23  .  Figure  5.3  summarizes  the  func¬ 

tional  relationships  between  (R and  x.  By  the  chain 


rule  then 
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All  that  remains  is  to  perform  the  required  partial  differ¬ 
entiations  on  equations  5.24  for  substitution  as  appropriate 
in  equations  5.25  through  5.27  so  that 
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It  is  left  to  the  computer  to  calculate  numeri¬ 
cally  the  partial  derivatives  described  by  equations  5.28, 
and  then  substitute  those  values  into  equations  5.25  through 
5.27  to  evaluate  the  h  matrix  terms.  Sequentially,  these 
computations  take  place  after  the  state  and  covariance  esti¬ 
mates  are  calculated,  and  before  the  filter  gains  are 
computed  for  each  iteration  k,  using  x(kjk-l)  in  all  cases. 
This  completes  the  observer  function  derivations. 
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D.  DISCUSSIOH  OF  EKF  TRACKING 
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Figure  5.4  True  and  Estimated  Target  Track 
From  Range,  Alpha,  and  Beta 

Using  the  DISSPLA  graphics  subroutines  at  the  program’s 
end,  several  sets  of  curves  were  generated.  Of  gereral 
interest  is  the  tracker’s  accuracy  when  F,<^,  and  $  are  all 
available,  as  opposed  to  R  and  X.  only,  or  X.  and  only 
(passive  tracking,  potentially ) .  The  series  of  graphs  that 
comprise  Figures  5.4  through  5.6  show  the  filter's  perform¬ 
ance  for  a  single  pass  of  the  satellite. 

From  these  three  graphs,  it  appears  that  the  filter 
estimate  does  converge  to  the  true  target  trajectory  in  all 
three  cases,  and  that  the  filter  estimate  is  more  accurate 
when  all  three  variables  are  present  than  when  only  two  are 
available.  A  single  run  of  a  random  process  has  a  minimal 
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Figure  5-5  True  and  Estimated  Target  Track 
From  Range  and  Alpha  Only 

amount  of  statistical  signif icance,  however;  thus  repeated 
trials  of  the  filter's  tracking  will  be  required.  In 
[Ref.  3],  Bar-Shalom  discusses  in  several  instances  the  need 
for  multiple  sequential  testing  of  any  filter  based  on 
stochastic  principles;  the  statistical  average  of  these 
"Monte  Carlo  runs"  then  begins  to  have  some  significance, 
increasing  in  value  in  direct  correlation  to  the  number  of 
runs  considered. 

First,  however,  a  criterion  must  be  established  for 
error  comparison.  Ear-Shalom's  suggestion  is  the  use  of  a 
state-squared  error  function,  defined  for  eack  k  as 

SSE(k)  =  %Cy)  . 

Application  of  this  criterion  to  this  filter  (not  shown 
here)  indicates  that  while  the  filter  is  able  to  track  the 
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Figure  5.6  True  and  Estimated  Target  Track 
From  Alpha  and  Beta  Only 


cget  in  all  cases,  there  is  room  for  improvement  in  its 
rformance.  Specifically,  the  quality  of  the  filter  opera- 
on  can  be  gauged  by  how  statistically  well  the  SSE  values 
t  within  a  confidence  interval,  where 

N  =  (number  of  runs)  X  (error  vector  dimension). 

this  case,  when  a  35%  confidence  interval  (i.e.  the 
jion  within  which  95%  of  the  SSE  values  should  fall  based 
the  probability  distribution)  is  considered,  less 

an  half  of  the  SSE  values  fall  within  it  for  any  of  the 
ree  cases  under  consideration.  Speculation  as  to  how  the 

Lter’s  performance  can  be  improved  is  reserved  for  Chapter 
;  in  the  meantime,  however,  a  simplified  criterion  can  be 
ployed  here  to  attempt  a  rough  evaluation  of  the  relative 
Eectiveness  of  the  three  different  modes  of  filter 
er ation. 
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Figure  5.7  Simplified  Error  Criterion  vs  Time 
For  a  Single  Trial  of  the  Filter 


A  simplified  error  criterion  that  suggests  itself  might 


SSSE(k)  =  'K*  Yj  +  Tl(i;  *%£) 


where  the  time  step  functions  as  a  scaling  factor  to  roughly 
eguate  the  significance  of  the  position  and  velocity  errors. 
Figure  5.7  shows  the  application  of  this  criterion  to  the 
single  run. 

Once  again,  the  results  seem  to  validate  the  hypothesis 
that  the  filter  works  better  for  .11  three  variables  than 
for  two,  but  this  is  still  information  gained  from  only  a 
single  trial.  Now  that  the  error  criterion  has  been  estab¬ 
lished,  however,  the  Konte  Carlo  runs  can  be  considered. 

The  number  of  runs  is  chosen  to  be  20,  and  the  first 
application  of  the  repeated  trials  was  to  smooth  out  the 
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Figure  5.8  True  and  Estimated  Target  Track 
From  fiance.  Alpha,  and  Beta 
For  Twenty  Monte  Carlo  Runs 


estimated  trajectories  in  Figures  5.4  through  5.6;  the 
result  was  the  series  of  Figures  5.8  through  5.10  .  The 

initial  perceptions  of  the  filter's  ability  to  track  the 
target  appear  to  have  been  borne  out,  that  is,  the  estimate 
does  converge  to  the  true  track  in  the  general  case,  and  the 
filter  tracks  better  when  all  three  variables  of  observation 
are  available.  However,  the  initial  error  in  the  estimated 
track  proved  not  to  be  an  anomaly  of  the  particular  trial, 
but  showed  up  repeatedly  throughout  the  Monte  Carlo  runs. 
This  suggests  an  imbedded  error  in  the  initialization 
process  for  the  filter,  possibly  in  the  initial  covariance 
estimate;  this  would  also  help  to  explain  the  filter's 
failure  to  place  the  SSE  values  in  the  Y'fc  confidence 
interval.  Examination  of  Figure  5.11,  which  shows  the 


1262.0  1263. 0  1261.0  1265.0  1266.0  1267.0  1268.0  1269.0  1270.0  1271.0  1272 

EASTERLY  MILES 

Figure  5.9  True  and  Estimated  Target  Track 
From  Range  and  Alpha  Only 
For  Twenty  Monte  Carlo  Runs 

simplified  error  criterion  for  the  20  runs,  also  tends  to 

validate  the  results  of  the  single  trial,  and  further 

supports  the  supposition  that  the  filter  correctly  tracks 
the  target  in  each  case,  although  there  is  some  initial 

error.  Finally,  Figures  5.12  and  5.13  were  drawn  to  take 

another  closer  look  at  the  quality  of  the  filter  estimates 
over  20  runs.  It  now  becomes  cbvious  that  a  primary  source 
of  error  is  in  the  initial  velccity  estimates.  Also,  the 
filter's  slow  (30  time  steps  or  7.5  minutes)  convergence  to 
the  true  velocities  indicates  that  some  error  in  the  initial 
covariance  estimate  is  indeed  present.  Ironically,  because 
one  initial  velocity  estimate  is  low  and  the  other  is  high, 
the  filter's  initial  estimate  of  the  target's  speed  is 
fairly  accurate;  it  is  the  estimate  of  target  course  that  is 
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Figure  5. 10  True  and  Estimated  Target  Track 
From  Alpha  and  Beta  Only 
For  Twenty  Monte  Carlo  Runs 

initially  in  significant  error.  This  could  well  be  a  func¬ 
tion  of  the  geometry  of  the  norlineari ties  of  the  problem, 
indicating  a  potential  pitfall  cf  assuming  that  white  noise 
will  remain  white  after  undergoing  several  nonlinear  trans¬ 
formations.  Tracking  targets  moving  in  other  directions 
might  well  shed  light  on  the  veracity  of  this  supposition. 

To  summarize  briefly,  although  the  filter’s  initializa¬ 
tion  might  be  improved,  it  nonetheless  demonstrates  an 
ability  to  track  the  target  in  all  three  modes  of  operation. 
It  provides  evidence  that  the  target  track  is  more  accurate 
when  all  three  variables  of  ohservation  are  available  as 
opposed  to  only  two,  but  that  operating  in  the  oi  -  /£  mode 
does  not  really  represent  a  sigrificant  degradation  over  the 
R- rji  mode.  This  is  an  important  result  because  it  allows  for 
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Figure  5.11  Siaplified  Error  Criterion  vs  Tiae 
For  Twenty  Honte  Carlo  Runs 

the  possibility  of  passive  target  tracking.  The  supposedly 
unobservable  R-^  mode  of  operation  is  not  attempted  because 
the  solution  of  the  equations  that  comprise  the  filter  algo¬ 
rithm  without  R  or  ^6  is  difficult  but  feasible,  but  without 
using  oC  it  becomes  impossible.  Verification  of  the  unob¬ 
servability  of  the  target  tracked  by  range  and  altitude 
angle  only  thus  requires  a  different  filter. 

This  completes  the  discussion  of  the  results  of  the  EKF 
tracking  a  surface  target,  and  concludes  the  analytical 
portion  of  this  thesis. 
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Figure  5.13  Easterly  Fosition  ws  Velocity 
For  Twenty  ilonte  Carlo  Runs 


71.  CCHCLOSIOHS  AND  RECOMMENDATIONS  FOB  FORTHEB  WORK 


During  the  evolution  of  this  thesis,  it  has  become  very 
clear  why  the  observability  of  nonlinear  systems  has  histor¬ 
ically  been  an  unsolved  problem,  at  least  in  the  most 
general  case,  and  inroads  have  teen  made  only  gradually  by  a 
relatively  few  individuals.  The  algebra  involved  in 
applying  any  mathematical  form  of  analysis  to  a  nonlinear 
system  is  frequently  so  prohibitive  as  to  make  such  proce¬ 
dures  of  questionable  value.  Consequently,  the  observ¬ 
ability  analysis  of  a  nonlinear  system  is  frequently  based 
as  much  on  intuition  as  demonstrable  mathematical  proof. 
Thus  while  the  statement  of  this  problem — observability 
analysis  for  a  satellite  tracking  an  earth-bound  target — is 
reasonably  simple,  it  quickly  bec.omes  obvious  its  formula¬ 
tion  is  not.  Specifically,  every  reference  available 
pertaining  to  either  the  satellite-target  dynamics  or  nonli¬ 
near  observability  uses  a  different  notation,  and  there  are 
very  clearly  defined  crossover  points  in  the  information 
available.  Most  sources  either  discuss  the  satellite's 
orbit  in  the  language  of  physics,  describe  target  observa¬ 
tions  in  a  purely  empirical  sense,  or  discuss  nonlinear 
observability  as  applied  to  a  general  state  space. 
Consequently,  one  of  the  major  objectives  of  this  thesis 
becomes  the  synthesis  of  as  much  available  information  as 
possible  on  the  entire  problem,  and  the  formulation  of  a 
pertinent  and  coherent  state  vector  model.  For  the  sake  of 
their  universal  recognition,  latitude  and  longitude  are 
retained  as  the  earth's  surface  coordinates,  although  much 
debate  has  taken  place  on  the  subject  of  alternative  coordi¬ 
nate  systems  that  might  pertain.  Certainly,  one  would  hope 
that  there  exists  another  reference  frame  wherein  the 


mathematical  observability  analysis  of  Chapter  17  could  be 
simplified  such  that  the  transformation  to  rectangular  coor¬ 
dinates  would  not  be  required.  Similarly,  the  calculations 
required  to  implement  the  filter  algorithm  of  Chapter  V 
might  aiso  be  streamlined.  Because  there  is  potential  for 
continued  exploration  of  these  and  other  aspects  of  this 
problem,  the  suggestions  for  further  work  made  below  are  no 
less  important  than  the  specific  conclusions  that  can  be 
drawn  from  this  research  effort. 

i.  conclusions 

As  is  so  frequently  the  case,  the  original  intent  of 
this  research  was  overly  ambitious  in  attempting  to  solve 
both  the  complex  nonlinear  observability  and  target  tracking 
problems.  The  results  presented  here,  however,  do  systemat¬ 
ically  show  the  interrelationship  of  these  problems,  such  as 
through  the  computation  of  the  Jacobian  matrices  for  the 
perturbation  analysis,  for  the  EKF,  and  for  the  observ¬ 
ability  analysis.  This  points  cut  the  need  for  an  efficient 
algorithm  for  high-order  Jacobian  evaluations. 

The  analysis  presented  here  forms  a  good  base  for 
continued  research  on  tracking  satellite  deployment  geometry 
and  desired  receiver  information.  The  parametric  descrip¬ 
tion  of  the  satellite  dynamics  pertinent  to  this  problem 
involves  a  great  deal  of  information  not  necessarily 
familiar  to  most  engineers.  This  research  proved  inter¬ 
esting,  and  is  well  documented  in  the  literature.  There  is 
a  wealth  of  diverse  information  available  in  sources  such  as 
[Ref.  5]  and  [Ref.  6].  The  intent  here,  however,  is  to 
integrate  this  information  into  a  coherent  overview  of  the 
mechanics  of  an  orbiting  satellite  and  its  observation  of  a 
target  moving  on  or  near  the  Earth’s  surface,  providing 
enough  information  to  fully  define  the  problem  without 
drowning  it  in  minutia. 


Next  the  physical  system  is  redefined  in  terms  of  the 
state  vector  space  more  familiar  to  Electrical  Engineers. 
Also,  the  analysis  establishes  the  computational  procedure 
for  translation  from  observed  satellite  data  to  earth 
surface  coordinates.  Appropriate  coordinate  selection  here 
is  obviously  crucial  to  the  o tserv ability  analysis.  Any 
method  of  locating  position  cr  describing  motion  on  a 
sphere,  however,  requires  a  radial  vector  and  two  angles, 
which  is  precisely  what  is  defined  by  latitude,  longitude, 
and  altitude  (i.e.  the  radial  vector  from  the  Earth's 
center) .  The  further  conversion  from  latitude  and  longitude 
to  northerly  and  easterly  distance  is  made  in  an  effort  to 
at  least  partially  linearize  the  problem;  the  merit  of  this 
decision  is  proven  by  simulation,  wherein  the  constant 
velocity  target  is  modeled  very  simply  in  these  coordinates. 
Had  latiude  and  longitude  been  retained  in  the  plant  coordi¬ 
nates,  even  this  simple  case  would  have  required  a  highly 
nonlinear  description. 

Kith  regards  to  target  observability,  the  simpler  cases 
considered  first  are  intended  to  provide  some  intuition 
about  the  problem.  From  the  linearized  case,  it  is  deter¬ 
mined  that  having  the  position  variables  available  for  two 
or  more  observations  is  equivalent  to  observing  both  posi¬ 
tion  and  velocity  during  a  single  look.  From  the  case  cf 
the  nonlinear  model  of  the  stationary  target,  it  becomes 
obvious  that  the  coordinates  derived  in  the  earlier  chapters 
are  not  especially  well- suited  to  this  method  of  observ¬ 
ability  analysis.  Thus  another  transformation  is  performed, 
this  time  from  the  spherical  space  into  a  rectangular  one. 
In  the  process,  it  is  discovered  that  a  stationary  target's 
position  can  be  fixed  with  twc  or  more  looks  at  a  single 
variable  of  observaticn,  which  might  pr  ive  of  great  utility 
if  it  is  desired  to  locate  passively  a  land-based  radar 
transmitter  or  communications  station.  When  the  moving. 


airborne,  general-case  target  is  ultimately  considered,  it 
is  shown  that  such  targets  prove  unobservable  when  only  a 
single  parameter  of  observation  is  available.  When  the 
variables  of  observation  are  considered  in  combination, 
however,  the  target  becomes  observable  in  virtually  every 
case  that  includes  at  least  one  position  variable.  The 
insight  developed  during  the  mathematical  der '  ation  of  the 
coordinates  suggests  that  the  R-/5  combinations  should  prove 
the  exception  to  this  rule,  and  lead  to  an  unobservable 
system  whether  considering  complete  state  or  just  position 
observability.  Demonstrating  unobservability  conclusively 
by  this  method,  however,  would  reguire  the  evaluation  of 
some  130,000  determinants;  thus  applying  the  analytical 
method  to  demonstrate  this  result  is  of  questionable  practi¬ 
cality.  While  a  complete  nonlinear  observability  analysis 
then  is  almost  impossible,  the  analytical  method  does 
provide  further  insight  into  relevant  aspects  of  observ¬ 
ability  for  the  problem.  One  particularly  important  result 
of  the  analysis  is  the  X-only  tracking  of  the  maneuvering 
surface  target,  and  the  ctrfi  tracking  of  the  general 
target,  both  very  useful  if  a  passive  sensor  is  of  tactical 
advantage.  As  a  footnote,  the  greater  sensitivity  of  the 
observer  matrices  to  fluctuations  in  /3  than  to  R  or  x.  is 
discussed  briefly;  further  development  of  this  topic  is 
certainly  possible,  although  tire  did  not  permit  it  here. 

The  first-cut  attempt  at  a  tracking  filter  design  serves 
to  validate  many  of  the  concepts  and  intuitions  brought  to 
light  during  the  observability  analysis,  including  the 
feasibility  of  <X-/5  tracking,  and  the  greater  accuracy 
possible  when  employing  all  the  variables  of  observation. 
The  inherent  problems  of  the  EKT  in  general  and  this  version 
in  particular  lead  one  to  conclude  that  this  is  not  the 
optimum  method  for  tracking  a  target.  Fortunately,  other 
methods  are  available,  including  the  Truncated  Second  Order 
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Filter  (ISO?)  and  the  Gaussian  Second  Order  Filter  (GSOF) 
both  discussed  in  [Bef„  9].  Iheir  greater  utility  should 
not,  however,  take  away  from  the  fact  that  this  EKF  does 
generate  an  estimate  that  converges  to  the  target's  actual 
track  in  all  three  phases  of  its  operation,  at  least  for  the 
small  number  of  cases  considered  here.  It  also  proves  that 
the  coordinates  developed  in  Chapters  II  and  III  to  describe 
the  problem,  while  not  particularly  well-suited  to  the 
observability  analysis  of  Chapter  IV,  work  demonstrably  well 
in  engineering  application. 

B.  RECOHHEBDATIOHS  FOB  FOBTBEB  SORK 

During  the  development  of  this  thesis,  it  became  obvious 
that  to  discuss  completely  ail  aspects  of  this  problem  at 
this  time  would  not  be  possible;  thus  these  recommendations 
for  further  work  are  made.  A  final  word  on  the  subject  of 
coordinate  selection:  for  every  equation  that  appears  in 

Appendix  A  as  part  of  the  Jacobian  observer  matrix  calcula¬ 
tions,  at  least  half  again  as  many  equations  were  derived 
during  abortive  attempts  to  apply  this  method  of  nonlinear 
observability  to  the  problem  in  other  coordinate  systems, 
including  latitude-longitude-altitude,  p-K  ,  and  R-a-a5  as 
the  plant  (i.e.  system)  coordinates.  None  of  these  provide 
any  simpler  mathematical  results;  in  fact,  they  all  prove 
even  more  complicated  to  employ.  Perhaps  by  redefining  the 
problem  in  terms  of  a  new  set  cf  coordinates  not  discussed 
in  this  thesis  the  observability  analysis  could  become  more 
streamlined  and/or  definitively  conclusive,  but  no  such 
coordinate  system  has  revealed  itself  thus  far. 

Next  the  question  of  the  tracking  filter  should  be 
addressed.  Had  more  time  been  available,  this  report  would 
have  attempted  to  improve  the  filter  performance,  either  by 
eradicating  the  inherent  errors  apparent  in  the  state  vector 
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and  covariance  matrix  initializations,  or  else  using  a  more 
sophisticated  filter  such  as  the  TSOF  or  GSOF.  Further,  a 
two-stage  nonlinear  filter  has  recently  been  proposed  which 
shows  superior  tracking  perf or  nance  to  any  of  these;  its 
specifications  and  performance  are  discussed  in  [Ref.  10] 
and  [Ref.  12].  The  employment  of  these  or  other  more 
complicated  filters  might  well  afford  the  opportunity  to 
verify  the  feasibility  of  an  ^-only  track  of  the  maneu¬ 
vering  surface  target  or  the  purported  unobservability  of 
the  R-/5  track.  The  goal  in  this  thesis,  however,  is  not 
actually  to  design  the  optimum  tracking  filter,  but  to 
demonstrate  the  possibility  of  doing  so.  The  EX  F  is  a  rela¬ 
tively  simple  algorithm,  and  thus  is  useful  here;  even  so, 
there  is  room  for  further  analysis  of  its  performance. 
Other  methods  of  initialization  might  be  considered,  partic¬ 
ularly  for  the  covariance  martix;  also,  the  tracking  of 
other  targets,  such  as  a  maneuvering  surface  target  cr  an 
air  target  with  its  six-dimensional  state  vector,  might  be 
attempted.  An  analysis  of  its  sensitivity  could  be 
conducted,  varying  both  the  system  and  the  observer  noises 
in  turn;  this  would  hopefully  validate  the  declaration  in 
Chapter  IV  that  the  system  should  be  more  sensitive  to  fluc¬ 
tuations  in  /5  than  those  in  R  cr  x  -  All  of  these  varia¬ 
tions  on  the  theme  of  filter  operation  could  of  course  aiso 
be  undertaken  for  the  alternative  filters. 

No  mention  has  been  made  thus  far  of  multiple  targets  or 
multiple  observers,  but  of  course  the  situation  explored  in 
this  thesis  is  the  simplest  possible,  that  is,  a  single 
target  being  observed  by  a  single  satellite  with  a  perfect 
probability  of  observation  when  in  view.  In  actuality,  of 
course,  the  problem  is  far  more  complicated,  as  the  consid¬ 
eration  of  multiple  targets  and  multiple  observers  immedi¬ 
ately  introduces  the  probability  of  false  target  detection; 
of  improper  correlation  of  targets  to  successive  or 
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Differentiating  once  with  respect  to  time, 
o  Y\CAA-*-ee)  -  U.  ( 


or 


&p  -  V\(a  v\ -v  <! e  )  —  \X{*\  (  G 

The  next  five  time  derivatives  are  taken  as  before,  and  then 
the  partial  derivatives  with  respect  to  n,  n,  e,  e,  h,  and 
h.  Eliminating  all  the  intermediate  steps  which  would 
follow  in  exactly  the  same  sequence  as  in  the  previous 
section,  the  resultant  observer  matrices  are 
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where 
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C.  OBSERVER  MATRICES  FOR  ALTITUDE  BEARING  AND  ALTITUDE 
BEARING  RATE 

The  derivation  of  the  J  and  J  matrices  for  tha  alti- 
tude  bearing  variables  and  £  is  the  lengthiest  of  all, 

but  using  the  lessons  learned  in  the  previous  two  sections, 
it  should  prove  no  more  difficult.  In  this  coordinate 
system, 

cor' 
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Obviously,  all  the  partial  derivatives  with  respect  to  h 
will  be  zero. 

This  leads  to  the  formation  of  the  and  J*  matrices 
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which  are  simplified  ty  the  same  sort  Of  row-reducing  method 
employed  in  the  J,  and  Jx  matrices.  This  time,  however,  all 
the  terms  do  not  cancel  simply,  and  the  result  is 
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Taking  the  partial  derivative  of  each  of  the  first  seven 
equations  with  respect  to  n  follows  the  same  pattern; 
solving  again  for  the  highest  order  derivative, 
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The  differentiations  with  respect  to  e  and  e  follow  the 
identical  pattern,  with  the  exception  that  the  £n,n,a.^  ) 
terms  are  replaced  by  (e,e,  aB-)  terms  of  opposite  sign,  so 
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Solving  for  the  highest  order  derivatives, 
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Solving  for  the  highest  order  derivative  in  each  equation, 
one  ottains 
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Taking  the  partial  derivative  of  each  of  the  first  seven 
equations  with  respect  to  n, 
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B.  OBSEBVEB  HATBICES  FOB  AZIMUTHAL  BEABING  AND  AZIMUTHAL 
BEABIHG  BATE 

The  derivation  of  the  Jacotian  observer  matrices  for  the 
azimuthal  bearing  variables  oC  and  K  follows  the  method  of 
the  previous  section,  except  that  the  result  is  not  quite  so 
algebraically  nice.  Consider  first  the  definition  of  in 
this  coordinate  system: 
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Differentiating  once  with  respect  to  time, 
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All  the  terms  for  the  H  matrix  J.t  have  already  been 
determined;  they  come  from  the  same  sets  of  equations  just 
derived,  only  the  first  is  left  off  and  the  last  is  aided 
on,  i.e. 
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3y  the  same  method  cf  row  reduction  just  employed,  this 
matrix  will  reduce  to 


and  n;  combining  those  results  will  lead  to  the  first 
observer  matrix  J  for  the  R  observation: 


J  = 


Note  that  the  last  equation  of  each  set  of  seven  partial 
derivatives  was  not  required  at  this  time;  they  will  become 
necessary  in  the  case  of  R.  The  lower  rows  of  this  matrix 
are  linear  combinations  of  the  rows  above  them;  to  simplify 
the  matrix  for  the  purpose  of  evaluating  its  determinant  and 
testing  it  for  positive  or  negative  definiteness,  it  must  be 
row-reduced  by  subtracting  each  of  the  higher  rows  (multi¬ 
plied  by  the  proper  constant)  from  the  lower  rows  as 
follows: 
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Taking  the  partial  derivatives  cf  the  first  set  of  eguations 
with  respect  to  n , 
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Solve  fox  the  highest  order  partial  derivatives  as  before. 
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Obviously,  partial  differentiation  with  respect  to  e  and 
*e  and  h  and  h  will  fellow  the  pattern  just  established  for  n 
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Taking  the  partial  derivative  of  each  of  the  above  equations 
with  respect  to  n, 
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Solving  for  the  highest  order  derivative  in  each  equation. 
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APPENPH  4 

DERIVATION  OF  OBSERVATION  MATBICES 


The  following  series  of  derivations  follows  the  pattern 
established  in  Chapter  4  Section  B  for  establishing  the 
terms  in  the  Jacobian  observer  iratrices  for  the  general  case 
target.  The  accelerations  are  assumed  to  be  piecewise 
constant  (i.e.  constant  for  each  time  step  of  a  discrete 
observer);  thus  third  and  higher  order  derivatives  of  the 
position  variables  will  be  zero.  The  derivations  are 
grouped  by  two's  into  B  and  E,  oL  and  aL  ,  and  and  for 
the  reason  that  many  of  the  terms  in  their  matrices  are  the 
same. 

A.  OBSEEVER  MATBICES  FOR  RANGE  AND  RANGE  RATE 

Consider  first  that  in  the  rectangular  coordinate 
system. 

Differentiating  this  eguation  implicitly  six  times  with 
respect  to  time, 
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simultaneous  observations;  and  of  missing  detection  alto¬ 
gether.  By  viewing  the  entire  process  start- to- finish  as 
stochastic  rather  than  deterministic,  the  problem  ultimately 
achieves  a  true  real-world  significance.  In  [Ref.  3], 
Bar-Shaiom  has  pulled  together  a  wide  variety  of  resources 
to  analyze  just  this  sort  of  situation  in  the  general  sense; 
the  application  of  the  principles  discussed  there  for  this 
particular  problem  would  arguably  generate  several  more 
reports  as  involved  as  this  one. 

On  a  higher  level,  the  theoretical  implications  of  the 
applicability  (or  limitations  thereof)  of  the  method  of 
[Ref.  1]  to  this  problem  and  others  of  equal  difficulty 
might  be  discussed.  Previous  employment  of  this  method  has 
shown  the  utility  of  such  observability  testing  in  deter¬ 
mining  the  lack  of  observability  of  the  bearing-only  target 
(BOT)  for  typical  earth-borne  radar  and  sonar  applications. 
The  complicated  geometry  of  this  problem  has  not  yet  yielded 
such  complete  conclusions;  the  potential  exists,  however. 
Another  topic  that  might  be  explored  further  is  the  perva¬ 
sive  nature  of  the  Jacobian  matrix,  which  appears  as  part  of 
the  observability  analysis;  in  the  development  of  the  nonli¬ 
near  observer  here  and  elsewhere,  i.e.  [Ref.  10], 
[Ref.  11],  and  [Ref.  12];  and  again  in  the  computation  of 
the  observer  functions  for  the  filter.  Finally,  tne  contin¬ 
uing  effort  must  be  made  to  resolve  all  these  results, 
current  and  future,  with  the  empirical  evidence  available  of 
track  observability  and  maintainability,  taking  into  account 
both  the  capabilities  of  the  sensor  and  the  wiles  of  the 
target. 
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APPENDIX  B 

PROGRAM  LISTING  FOR  THE  SATELLITE-TARGET  SIMULATION  AND  THE 

EKF  IMPLEMENTATION 


EEC L ARE  ALL  VARIABLES 
INTEGER  I# J*K, FLAG  1 
REAL  DT,PI. AO.DPHI, 
REAL  HO .RHOMAX/RHO, 
REAL  LATS  (121)  -  LONG 
REAL  RANGE  (12lf, ALP 
REAL  XI  (121)  .X2  (121 
REAL  XHAT1  M*1)',XHA 
REAL  PI  (12 T)  -P3  (121 
REAL  XNHAT1  -XNHAT2- 
REAL  PN9  , PN  A  - P  NE. PN 
REAL  PNF, RHOHAT.ALK 
REAL  DHHDNU,ENUDX1, 
REAL  DALDRH.DALDNU, 
REAL  HI ,H2,H3,H4,A, 
REAL  Q4.Q5.Q6,R5,R6 
REAL  aGI  (12  11-YG1 (1 
REAL  XAVE1  (Izl)  ,XAV 
REAL  LONHAT.IGNGT (1 
REAL  P3  (1 2 1 J -PC ( 12 1 
REAL  NUHAT,EALDX3,D 
REAL  SSE3ARll21)  ,E2 
DOUBLE  PRECISION  DS 


A.  I  1  *  4.  I  I  #  A  A  I  I  U  f  Awl  14  II  #  A  *T  l  I  iL  II  *  Z  2L  I  I  4  II 

XHATljlSl)  ,XHATz1l2l)  .XHAT3  M21)  -XHAI4  (121) 
PI  (12 T)  -P3  (121)  .  P4(121)  ,?9  (T21)  ,PA  (121)  -ESIG 
XNHAT1  -XNHAT2- XNH AT3, XNHAT4 , PN1 .INNOVA. *SIG 

nwrt  n\T  >  -r  v  -r  r>.  hnn  r*  n  r*  ^7  r*  r>  t  u  h  n  tt  r,  n-r  /— 


ro  (  I  Z  I  1  .  irC  I  (z  I  )  .  I  bN  u  if  d  ,  i>  GA  .  G  3  .  i 

NUHAT.EALDO.DALDIA.DBEDXl  ,D3EDX3.XG2 (121 ) 
SSE3AR  (121)  ,E2,E3,E4,G3#G4,G5,G6,G7,Q7 
E  PRECISION  DSEED 


CONSTANTS 


FLAG  1=0 

?LAG2=0 

DT=. 25 

PI=3,  1415926 

A0  =  1 ,  1065387 

DPHI=EI/53.7243 

OMEGA=PI/720. 

R0  =  3  428. 

R  S=4  038  . 

RHOMAX=ACOS (RO/RS) 

ASIG  =  EI/1  09000. 

BS  IG=  El/ 10 80 00. 

E  SIG  =  .002 
NSIG=  .002 
RSIG  =  .1 
AS2=ASIG**2 
BS2  =  B  SIG**2 
ES2=  ESIG**2 
N  S2=N  SIG*  *2 
RS2=RSIG**2 

FOR  ALTERNATIVE  OBSERVATIONS 


OUTER  OUTER  LOOP  FOR  ALT ERNATIVI 
DO  36  I NK= 1,3 

DSEED=  1 23486  579. 

CUTER  LOOP  FOR  MONTE  CARIO  RUNS 
DO  92  1=1.121 
XAVE1  (I)  =0. 

XAVS2  I)  =0. 

XAVS3  T) =0. 

XAVE4  lf=0. 

SSE3AR  (I) =0. 

CONTINUE 
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DO  94  N=1,20 

INITIALIZE  TIME,  POSITIONS,  MEASUREMENTS 

TIME  (1)  =0  . 

LATS  M)  =0. 

LONGS  (1)  =0. 

LATTJ  1)  =45  .*PI/1  80  . 
LONGT  (1)  =30.*PI/180. 
RANGE  1)  =0. 

ALPHA  <1)=0. 

BETA  (1)  =0. 

XI  (1)  =R0*LATT (  1) 

X2  (1)  =.3333333 


X3  (1)  =RO*COSj(LATT(1) )  ♦LONGT(I) 
X4  h)  =-.3333333 


LOOP  TO  UPDATE  TIME,  POSITIONS.  MEASUREMENTS 

DO  10  1=2,121 
K=  I  - 1 

TIME  (I)  =DT*FLOAT  (K) 

SATELLITE  POSITION 
PHI=DPHI*  TIME  (I) 

DENOM=COS  (PHI)  **2+  (CCS  (AO)  ♦  SIN  (PHI) )  **2 
DL0NGS=DPHI*C6S (AO)  /EE NOM -OMEGA 
DLATS=DPHI*SIN  (AO)  ♦  CCS(PHI)  /DENOM**.  5 
LATS  (I)  =IATS  (K)  +DT*DIATS 
LONGS  (I)  =  LONGS  (K)  +DT*DLONGS 

TARGET  POSITION 

HN 1  =  N  SIG*GGNQF (DSEED ) 

WN2=ESIG*GGNQF (DSEED) 

XI (I) =X1  (K) +DT*X2 (K) +DT**2*W  N 1/2. 

X2(I  =X2 ( K  +DT*WNT 
X3  fl'  =X3  i  K)  +DT*X4  (X)  +DT**2*WN2/2. 

X4jl'  =X4  (K  +DT*HN2 
LATT  (I)  =X1  JI)/R0 
LONG!  (I)  =X3  (I)  /  (R0*CCS  (LATT  (I)  )  ) 

MEASUREMENTS 

NU=LONGT  (I) -LONGS  (I) 

RHO=ACOS  (SIN  (LATT  (l))*SIN  (LATS  (I)  )  +COS  (LATT  (I)  ) 
♦COSjLATSJI)  )  *COS  (NU)  ) 

IF  (R  HO.  LE.RHOMA  X)  GC  TO  30 

IF  {  (FLAG1.NE.  1)  .OR.  (FLAG 2.  NE .0)  )  GO  TC  60 
COUNT 2=K 
FLAG2= 1 


RANGE  (11=0. 
ALPHA  (I)  =0. 
BETA  (11=0. 
GO  TO  10 


IF  (FLAG1.EQ.0)  COUNT1=I 
FLAG1=1 

RANGE  (I)=  (R0**2+RS**2-2.  *RO*RS*COS  (RHO)  )  **.5 
+  RSIG*GGNQF  (DSEED) 

ALPHA  (I)  =  ASIN  (COS  (LATT  (I)  )  *SIN  (NU)/SIN  (RHO)  ) 

+  ASIG*GGNQF  (DSEED) 

IF  (LATTJI)  .LT.LATS(I)  )  ALPHA  (I)  =PI-ALPHA  (I) 
BETA  (I)=ASlN(R0*S  IN  (RHoJ /RANGE  ( I)  J 


IF  (I 
BETA  (I) 


♦ESIG*GGNQF  ( 


♦SIN  (NU)  /SIN  (RHO)  ) 


CONTINUE 

M=COUNT2-CO  UNT1+1 


ESTIMATION 

TARGET  NOT  YET  IN  SIGHT 


CONTINUE 


J=COU  NT  1-  1 
DO  40  1  =  1  ,  J 
XHAT1  (I)  =0. 
XHAT2  I)  =0. 
XHAT3  I)  =0. 
XHAT4  I)=0. 


TWO-POINT  INITIALIZATION 
J=CODNT 1+1 
DO  80  I=COUNTl ,  J 

EHO=ASIN  (RANGE  (I)  *S  I 
LATHAT=A SIN  (SIN  (LATS 
*SIN  (BHO)  *COS 
NO=ACOS  {  (COS  (BHO)  -SI 


THE  EKF 


*S  IN  (BHO)  *COS  ALPHA  (I) 
=  ACOS  (  (COS  (BHO)  -SIN(LATHAT 
(COS(LATHAT)  *COS  (UTS  (I)  ) 
IF  ULPHAfl)  iGE.PI)  NU=-NU 


+COS  (L  ATS  ( I)  ) 
(LATS  (I)  ) )  / 


IF  (ALPHA  (I).  GE. 
LONHAT=LGNGS7l) +  NU 
XHAT1  (I)  =E0*IATHAT 


XHAT1  (] 
XHAT2  ] 
XHAT3  ] 
XHAT4  {] 

CONTINUE 


=eo*Lathat 

=  0. 

=BO*COS  (LAT  H  AT)  *LONHAT 

=  0. 


XHAT2  (J)  =  (XHAT1  £  J)  -XHAT1  (COUNT1)  )/DT 
XHAT4  (J)  =  (XHAT3{JJ-XEAT3(COUNT1)  J  /DT 
PI  (J)  =NS2 


UPDATE  THE  EKF 


PD  J  =NS2/DT 

P4  J  =2.*NS2/DT**2 

P3  J  =ES2 

PF  J  =ES2/DT 

P9  J  =2. *E S2/DT**2 

PA  J  =0. 

PB  J  =0. 

PC  J  =0. 

PE  J  =0. 


J=J+  1 

DO  50  I=J , COUNT2 
K=I-1 


STATE  AND  COVAEIANCE 


PN1  =P  1 
PND=PD  i 
PN4  =  P4  \ 
PN3=P3 
PNF=P  F 
EN9  =  P9 
PNB=PB i 
PNA=  P  A 
PNE=P  E 
PNC=  PC i 


ESTIMATES 
XNH AT 1=XHAT1 
XNH  AT2=XHAT2 
XNH  AT3=XHAT3 
XN  H  AT4=  XHAI4 


♦DT+XHAT2 (K) 
♦DT*XHAT4  (K) 

)  *NS2*BT**4/4. 


+2.  *DT*PD(X)+DI**2*P4  (K)  *NS2*BT**4/4. 
♦DT*P4(K)  +  N52*DT**3/2. 

+  NS2*DT**2 

+  2.  *DT*PF  (K)+DI**2*P9  (  K)  ♦ES2*DT**4/4. 
+DT*P9(K) +  E22*DT**3/2. 

+  ES  2  *  Dx  *  St  2 

+DT*  (PE  (K)  +PA  (K)  )  +DT**2*PC  (K) 
+DT*PC(K) 


+DT*PC 


OBSERVEE  FUNCTIONS 
LATHAT=  XN  HAT  1 /R0 
LONHAT=XN HAT3/  (RO  *COS  (LATHAT)  ) 

NUHAT=LONHAT-LONGS (I) 

EHOHAT=  ACOS  (SIN  (LATHAT)  *SIN  (LATS  (I)  )  +COS  (LATHAT) 
*COS(LATS(in  *COS(NUHAT)  ) 

BHAT=  (R0**2+RS**2-2.  *RO*HS*COS  (E  HO  HAT))**. 5 
ALH AT=ASI N  (COS  (LATH Al5  *S IN(NU KA T) /SIN  (RHOHAT)) 

IF  {LATHAT,  LT.LATSfl))  ALH AT=  PI-ALH AT 
BEHAT=ASIN  (R0*SIN  (EKCHAT)  /BHAT) 

DLADX 1=1. /EO 


DRHD1 A= 


DRHDNU=C05  {LATHAT)  *CCS  (L 
SIN  (RHOHAT) 

DNUDX 1=XNHAT3*SIN  (LATHAT 
DRHDX  1=DRHELA*DLADX  1  +DRH 
DRADR  H=R0*RS*SIN  (RHOHATi 
rwrirnr  "?=:l .  /  tv  n*nn  jihit 


NUHAT) - 
RHOHAT) 
UHAT)  / 


RO*COS (LATHAT) ) **2 
♦DNUDXT 


DRHDX  1=DRBELA*DL ADX  1  ♦DRHDNu*DNU  DX  T 
DRADR  H=R0  *RS*S  IN  {RHOHATi/RH  AT 
DNODX3=1  .  /  (R0*CQ  S  (LA  THAT)  ) 

DEADX  1=DRAERH*DRHDX  1 

DR A  DX  3= DR  ADR  H*DR  HDNU^DNUD  X3 

DALD1A=-S IN  (LATHAT)  *SIN  (NUHAT)  /  {COS  (ALHAT) 

♦SIN  RHOHAT)  ) 

DALDRH=-COS  LATHAT)  ♦SIN  (NUHAT)  *  COS  (P.HOIiAT)/ 

(COS  ALHAT)  *SIN  (RHOHAT)  **2) 

DALDNU=CO  5  (LATHATUcCS  (NUHAT)  /  (COS  (ALHAT) 

♦  SIN  (RHOHAT)  ) 

DALDX 1=DALD£a*DLADa l +DALDRH*DRHDX1 +DALDNU*DNUDX1 


DBEDX3=DB ZDR A*DRADX3 +DEEDRH*DRHDNU*DNUDX3 

H1=DR  ADX  1 

H2=DALDX1 

H3=DBEDX  1 

H4=DR ADX3 

K5=DALDX3 

H6=DB  EDX3 

IP  (INK-EQ.2)  H  3  =  0  . 

IF  INK. EQ. 2  H6=0 . 

IF  i INK.EQ. 3  H 1  =  0 . 

IF  i  INK.EQ.  3'  H4=  0  . 


INK  .  F( 


H  3  =  0  . 
H6=  0  . 
H  1  =  0  . 
H4=  0  . 


GAINS 

A=RS2+PN1 *H1 **2+2. *P  NB*H 1*H4+PN  3*H4**  2 
B=PN 1*H 1*  H2+PNB* ( H 1 *H5+H2*H4)  +PN3*H4*H5 
C=AS2+PN 1 *H2**2+2 . *PNB*H2*H5+PN3*H5**2 
D=PN1 *H 1*H3+PNB* (H1*E6+H3*H4)  +PN3+H4+H6 
E=PN  1  *H2*H3+PN3*  1h2*H6+H3*H5)  +PN3*H5*H6 
F=BS2+PN1 *H3**2+2. *PNB*H3*H6+PN3*H6**2 
DET=A*C*F+2. *B*E*D-C*D**2-F*B**2-A*E*  *2 


Q 4=  (B*E-C*D)  /DET 

Q5=  B*D-A*e)  /DET 

Q6=  (A*C— B**2)  /DET 

P1=H1*PN1+H4*PNB 

R2=H2*PN 1+H5*PNB 

R3  =  H3*PNUH6*PNB 

R4=E1*PND+H4*PNE 

R5  =  H2*PND+H5*PNE 

R6  =  E3*PND+H6*PNE 

R7=H1*PNB+H4*PN3 

R8=E2*PNB+H5*PN3 

R9=H3*PNB*H6+PN3 

RA=E1*PNA+H4*?NF 

RB=H2*PNA+H5*?NF 

RC=E3*?NA+H6*PNF 

G1=E1*2 1+R2*Q2+R3*Q4 

G2=E1 *Q2+R2*Q3+R3*Q5 

G3=E1*G4+R2*G5+R3*Q6 

G4=E4*Q1+R5*Q2+R6*Q4 

G5=E4*Q2*R5*Q3+R6*Q5 

G6=E4*Q4+R5*Q5+E6*Q6 

G7=E7*Q 1 +R3*Q2+R9*Q4 

G8=E7*Q2+R3*Q3+R9*Q5 

G9=E7+q4+R8*Q5+R9*Q6 

GA=  EA*Q  1  +RB*Q2+RC*Q4 
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GB=BA*Q2+RB*C3*RC*Q5 
GC  =  RA*Q4  +  R3*Q5+RC*Q6 

STATE  AND  COVARIANCE  UPEATES 
INNOVA  =  AL?HAj[I)  -ALHAT 
INNOVB=BETAVi) -BEHAT 
INNOVR=RAHGE  (I)-RHAT 

XHAT1  (I) =XNEAT l+G 1*1 NNOVR+G2* IN  NOVA+G3* INNO VB 
XHAT2  I) =XNHAT2+G4*IKNGVR+G5*INN07A+G6*INN0VE 
XHAT3  I) =  XNHAT3+G7*I NNGVR+G8*INNOVA+G9*INNOVE 
XHAT4  I) =XNHAT4+GA*INNOyR+G3*INNOVA+GC*INNOV£ 

51  =  1.-G1*H1-G2*H2-G3*H3 

52  =  -G1*H4-G2*H5-G3*H6 
S3=-G4*H1-G5*H2-G6*H3 

54  =  -G4*H4-G5*H5-G6*H6 

55  =  -G7*H  1 -G8  *H  2-G9  *H  3 
S6=1.-G7*H4-G3*H5-G9*H6 
Sl  =  -Gk*ti  1-G  B*H  2-GC*H  3 
S8  =  -GA*H4-GB*H5-GC*H6 
PI  (I)  =S1*PN1+S2*PNB 

PD  I  =S  1*PND  +  S2*?NE 
P4  I  =S3*PND+S4*?NE+PN4 
P3  I)  =S5*PNB+S6*PN3 
PF  I  =S5*PNA+S6*PNF 
P9  T  =S7*PNA+S8*PNF+PN9 
PA  'I  =S1*PNA+S2*PNF 
PB  (I  =S  1*PNB+S2*PN3 
PC  I  =S3*PNA+S4*PNF+?NC 
PE  (3)  =S5*PND  +  S6*PNE 

AVERAGED  PERFORMANCE  AND  SQUARED  ERROR  FUNCTIONS 
XAVE1  (I)  =XAVE1  (I)  +XHAT1  (I)  /20. 

XAVE2 iT  - XAVE2  I) +XHAT2  I) *3. 

XAVE3  I  =XAVE3(r  +X  E  AT  3  1/20. 

XAVE4  I  =XAVE4  i  I'  +XHAT4  fl'  *3. 

E  1=X  1  I  -XHAT1  I 
E2=X2  I  -XHAT2  I 
£3=X3  (i;  -XHAT3  (I 
E4=X4  ;i  -XHAT4  I' 

SSE  (I)  =  (E2**2+E4**2)  *DT**2+E1  **2+E3**2 
SSEBAR(I)  =SSEBAR  (I)  +  sSE(I)/20. 

CONTINUE 

TARGET  OUT  OF  SIGHT 

J=COUNT2* 1 
DO  70  I=J, 121 
K=I-1 

XHAT1  (I)  =XHAT  1  (K)  +DT*XHAT2  (K) 
XHAT2  I  =XHAT2  K' 

XHAI3  T)  =X HAT3  K  i  +DT*XHAT4  (K) 
XHAT4  i;  =XH AT4  i'K  i 

CONTINUE 

CONTINUE 


GRAPHICS 


J=C  OU  NT  1  +  2 
K=  M-2 
DO 


90  I=J, 

,  COUNT 2 

L=I  -  J+  1 

IF  (INK. 

,  NE.  1)  GO 

XG  1  (L) 

=XAVS3 (I 

YG  1(L 

=XAVE4 (I 

GO  TO 

90 

IF  (INK. 

.  NE.2)  GO 

XG2  (L) 

=XA VE3 (I 

Y  G  2_C  L) 

=XAVE4 ( I 

GO  TO 

90 

TO  8  4 


TO  8  2 


XG3 

YG3 


ftl«AVE3 


:XAVE4 


If! 
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